URL
https://opencores.org/ocsvn/minsoc/minsoc/trunk
Subversion Repositories minsoc
[/] [minsoc/] [trunk/] [sw/] [support/] [support.c] - Rev 80
Compare with Previous | Blame | View Log
/* Support */ #ifndef OR32 #include <sys/time.h> #endif #include "or1200.h" #include "support.h" #include "int.h" #ifdef UART_PRINTF #include <uart.h> #endif #if OR32 void int_main(); void ext_except() { int_main(); } /* Start function, called by reset exception handler. */ void reset () { int i = main(); or32_exit (i); } /* return value by making a syscall */ void or32_exit (int i) { asm("l.add r3,r0,%0": : "r" (i)); asm("l.nop %0": :"K" (NOP_EXIT)); while (1); } #ifdef UART_PRINTF static int uart_init_done = 0; #define PRINTFBUFFER_SIZE 512 char PRINTFBUFFER[PRINTFBUFFER_SIZE]; // Declare a global printf buffer void minsoc_printf(const char *fmt, ...) { // init uart if not done already if (!uart_init_done) { uart_init(); uart_init_done = 1; } va_list args; va_start(args, fmt); //int str_l = vsnprintf(PRINTFBUFFER, PRINTFBUFFER_SIZE, fmt, args); int str_l = vfnprintf(PRINTFBUFFER, PRINTFBUFFER_SIZE, fmt, args); if (!str_l) return; // no length string - just return int c=0; // now print each char via the UART while (c < str_l) uart_putc(PRINTFBUFFER[c++]); va_end(args); } #else /* activate printf support in simulator */ void minsoc_printf(const char *fmt, ...) { va_list args; va_start(args, fmt); __asm__ __volatile__ (" l.addi\tr3,%1,0\n \ l.addi\tr4,%2,0\n \ l.nop %0": :"K" (NOP_PRINTF), "r" (fmt), "r" (args)); } #endif /* print long */ void report(unsigned long value) { asm("l.addi\tr3,%0,0": :"r" (value)); asm("l.nop %0": :"K" (NOP_REPORT)); } /* just to satisfy linker */ void __main() { } /* start_TIMER */ void start_timer(int x) { } /* For writing into SPR. */ void mtspr(unsigned long spr, unsigned long value) { asm("l.mtspr\t\t%0,%1,0": : "r" (spr), "r" (value)); } /* For reading SPR. */ unsigned long mfspr(unsigned long spr) { unsigned long value; asm("l.mfspr\t\t%0,%1,0" : "=r" (value) : "r" (spr)); return value; } #else void report(unsigned long value) { printf("report(0x%x);\n", (unsigned) value); } #endif