Adding lm32 demo to SAKC project

lm32/logic/sakc/firmware/gdb-test/soc-hw.c

@@ -0,0 +1,133 @@
+#include "soc-hw.h"
+
+uart_t   *uart0  = (uart_t *)   0xf0000000;
+timer_t  *timer0 = (timer_t *)  0xf0010000;
+gpio_t   *gpio0  = (gpio_t *)   0xF0020000;
+
+isr_ptr_t isr_table[32];
+
+
+void tic_isr();
+/***************************************************************************
+ * IRQ handling
+ */
+void isr_null()
+{
+}
+
+void irq_handler(uint32_t pending)
+{
+	int i;
+
+	for(i=0; i<32; i++) {
+		if (pending & 0x01) (*isr_table[i])();
+		pending >>= 1;
+	}
+}
+
+void isr_init()
+{
+	int i;
+	for(i=0; i<32; i++)
+		isr_table[i] = &isr_null;
+}
+
+void isr_register(int irq, isr_ptr_t isr)
+{
+	isr_table[irq] = isr;
+}
+
+void isr_unregister(int irq)
+{
+	isr_table[irq] = &isr_null;
+}
+
+/***************************************************************************
+ * TIMER Functions
+ */
+void msleep(uint32_t msec)
+{
+	uint32_t tcr;
+
+	// Use timer0.1
+	timer0->compare1 = (FCPU/1000)*msec;
+	timer0->counter1 = 0;
+	timer0->tcr1 = TIMER_EN;
+
+	do {
+		//halt();
+ 		tcr = timer0->tcr1;
+ 	} while ( ! (tcr & TIMER_TRIG) );
+}
+
+void nsleep(uint32_t nsec)
+{
+	uint32_t tcr;
+
+	// Use timer0.1
+	timer0->compare1 = (FCPU/1000000)*nsec;
+	timer0->counter1 = 0;
+	timer0->tcr1 = TIMER_EN;
+
+	do {
+		//halt();
+ 		tcr = timer0->tcr1;
+ 	} while ( ! (tcr & TIMER_TRIG) );
+}
+
+
+uint32_t tic_msec;
+
+void tic_isr()
+{
+	tic_msec++;
+	timer0->tcr0     = TIMER_EN | TIMER_AR | TIMER_IRQEN;
+}
+
+void tic_init()
+{
+	tic_msec = 0;
+
+	// Setup timer0.0
+	timer0->compare0 = (FCPU/10000);
+	timer0->counter0 = 0;
+	timer0->tcr0     = TIMER_EN | TIMER_AR | TIMER_IRQEN;
+
+	isr_register(1, &tic_isr);
+}
+
+
+/***************************************************************************
+ * UART Functions
+ */
+void uart_init()
+{
+	//uart0->ier = 0x00;  // Interrupt Enable Register
+	//uart0->lcr = 0x03;  // Line Control Register:    8N1
+	//uart0->mcr = 0x00;  // Modem Control Register
+
+	// Setup Divisor register (Fclk / Baud)
+	//uart0->div = (FCPU/(57600*16));
+}
+
+char uart_getchar()
+{   
+	while (! (uart0->ucr & UART_DR)) ;
+	return uart0->rxtx;
+}
+
+void uart_putchar(char c)
+{
+	while (uart0->ucr & UART_BUSY) ;
+	uart0->rxtx = c;
+}
+
+void uart_putstr(char *str)
+{
+	char *c = str;
+	while(*c) {
+		uart_putchar(*c);
+		c++;
+	}
+}
+