URL
https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk
Subversion Repositories openrisc_me
[/] [openrisc/] [tags/] [gnu-src/] [newlib-1.18.0/] [newlib-1.18.0-or32-1.0rc1/] [libgloss/] [sparc/] [salib.c] - Rev 345
Compare with Previous | Blame | View Log
/* Stand-alone library for SPARClite * * Copyright (c) 1995 Cygnus Support * * The authors hereby grant permission to use, copy, modify, distribute, * and license this software and its documentation for any purpose, provided * that existing copyright notices are retained in all copies and that this * notice is included verbatim in any distributions. No written agreement, * license, or royalty fee is required for any of the authorized uses. * Modifications to this software may be copyrighted by their authors * and need not follow the licensing terms described here, provided that * the new terms are clearly indicated on the first page of each file where * they apply. */ #include "sparclite.h" #include "asm.h" /* LED blinking pattern can be changed by modifying __led_algorithm. */ enum ledtype { led_marching, /* marching pattern, only one led on at a time */ led_random, /* pseudo-random pattern */ led_blinking, /* all leds blink on and off */ led_none /* leds off all the time */ }; enum ledtype __led_algorithm = led_marching; /* Pointer to hook for outbyte, set by stub's exception handler. */ void (*__outbyte_hook) (int c); #ifdef SL931 #define SDTR_BASE 0x200 #define SDTR_ASI 1 #define SDTR_SHIFT 0 #else #define SDTR_BASE 0x10000000 #define SDTR_ASI 4 #define SDTR_SHIFT 16 #endif #define get_uart_status(PORT) \ (read_asi (SDTR_ASI, SDTR_BASE + 0x24 + (PORT) * 0x10) >> SDTR_SHIFT) #define xmt_char(PORT, C) \ write_asi (SDTR_ASI, SDTR_BASE + 0x20 + (PORT) * 0x10, (C) << SDTR_SHIFT) #define rcv_char(PORT) \ (read_asi (SDTR_ASI, SDTR_BASE + 0x20 + (PORT) * 0x10) >> SDTR_SHIFT) void putDebugChar(); #if 0 void set_uart (cmd) int cmd; { write_asi (SDTR_ASI, SDTR_BASE + 0x24, cmd << SDTR_SHIFT); } void set_timer_3 (val) int val; { write_asi (SDTR_ASI, SDTR_BASE + 0x78, val << SDTR_SHIFT); } #endif asm(" .text .align 4 ! Register window overflow handler. Come here when save would move us ! into the invalid window. This routine runs with traps disabled, and ! must be careful not to touch the condition codes, as PSR is never ! restored. ! ! We are called with %l0 = wim, %l1 = pc, %l2 = npc .globl " STRINGSYM(win_ovf) " " STRINGSYM(win_ovf) ": mov %g1, %l3 ! Save g1, we use it to hold the wim srl %l0, 1, %g1 ! Rotate wim right sll %l0, __WINSIZE-1, %l0 or %l0, %g1, %g1 save %g0, %g0, %g0 ! Slip into next window mov %g1, %wim ! Install the new wim std %l0, [%sp + 0 * 4] ! save L & I registers std %l2, [%sp + 2 * 4] std %l4, [%sp + 4 * 4] std %l6, [%sp + 6 * 4] std %i0, [%sp + 8 * 4] std %i2, [%sp + 10 * 4] std %i4, [%sp + 12 * 4] std %i6, [%sp + 14 * 4] restore ! Go back to trap window. mov %l3, %g1 ! Restore %g1 jmpl %l1, %g0 rett %l2 ! Register window underflow handler. Come here when restore would move us ! into the invalid window. This routine runs with traps disabled, and ! must be careful not to touch the condition codes, as PSR is never ! restored. ! ! We are called with %l0 = wim, %l1 = pc, %l2 = npc .globl " STRINGSYM(win_unf) " " STRINGSYM(win_unf) ": sll %l0, 1, %l3 ! Rotate wim left srl %l0, __WINSIZE-1, %l0 or %l0, %l3, %l0 mov %l0, %wim ! Install the new wim restore ! User's window restore ! His caller's window ldd [%sp + 0 * 4], %l0 ! restore L & I registers ldd [%sp + 2 * 4], %l2 ldd [%sp + 4 * 4], %l4 ldd [%sp + 6 * 4], %l6 ldd [%sp + 8 * 4], %i0 ldd [%sp + 10 * 4], %i2 ldd [%sp + 12 * 4], %i4 ldd [%sp + 14 * 4], %i6 save %g0, %g0, %g0 ! Back to trap window save %g0, %g0, %g0 jmpl %l1, %g0 rett %l2 ! Read the TBR. .globl " STRINGSYM(rdtbr) " " STRINGSYM(rdtbr) ": retl mov %tbr, %o0 "); extern unsigned long rdtbr(); void die(val) int val; { static unsigned char *leds = (unsigned char *)0x02000003; *leds = val; while (1) ; } /* Each entry in the trap vector occupies four words. */ struct trap_entry { unsigned sethi_filler:10; unsigned sethi_imm22:22; unsigned jmpl_filler:19; unsigned jmpl_simm13:13; unsigned long filler[2]; }; extern struct trap_entry fltr_proto; asm (" .data .globl " STRINGSYM(fltr_proto) " .align 4 " STRINGSYM(fltr_proto) ": ! First level trap routine prototype sethi 0, %l0 jmpl 0+%l0, %g0 nop nop .text .align 4 "); /* Setup trap TT to go to ROUTINE. If TT is between 0 and 255 inclusive, the normal trap vector will be used. If TT is 256, then it's for the SPARClite DSU, and that always vectors off to 255 unrelocated. */ void exceptionHandler (tt, routine) int tt; unsigned long routine; { struct trap_entry *tb; /* Trap vector base address */ if (tt != 256) tb = (struct trap_entry *) (rdtbr() & ~0xfff); else { tt = 255; tb = (struct trap_entry *) 0; } tb[tt] = fltr_proto; tb[tt].sethi_imm22 = routine >> 10; tb[tt].jmpl_simm13 = routine & 0x3ff; } void update_leds() { static unsigned char *leds = (unsigned char *)0x02000003; static enum ledtype prev_algorithm = led_none; if (prev_algorithm != __led_algorithm) { *leds = 0xff; /* turn the LEDs off */ prev_algorithm = __led_algorithm; } switch (__led_algorithm) { case led_marching: { static unsigned char curled = 1; static unsigned char dir = 0; *leds = ~curled; if (dir) curled <<= 1; else curled >>= 1; if (curled == 0) { if (dir) curled = 0x80; else curled = 1; dir = ~dir; } break; } case led_random: { static unsigned int next = 0; *leds = next & 0xff; next = (next * 1103515245 + 12345) & 0x7fff; break; } case led_blinking: { static unsigned char next = 0; *leds = next; next = ~next; break; } default: break; } } /* 1/5th of a second? */ #define LEDTIME (20000000 / 500) unsigned long ledtime = LEDTIME; int inbyte() { return (getDebugChar()); } int getDebugChar() { unsigned long countdown = ledtime; update_leds(); while (1) { if ((get_uart_status(0) & 2) != 0) break; if (countdown-- == 0) { countdown = ledtime; update_leds(); } } return rcv_char(0); } /* Output one character to the serial port */ void outbyte(c) int c; { if (__outbyte_hook) __outbyte_hook (c); else putDebugChar(c); } void putDebugChar(c) int c; { update_leds(); while ((get_uart_status(0) & 1) == 0) ; xmt_char(0, c); } #if 0 int write(fd, data, length) int fd; unsigned char *data; int length; { int olength = length; while (length--) putDebugChar(*data++); return olength; } int read(fd, data, length) int fd; unsigned char *data; int length; { int olength = length; int c; while (length--) *data++ = getDebugChar(); return olength; } #endif /* Set the baud rate for the serial port, returns 0 for success, -1 otherwise */ #if 0 int set_baud_rate(baudrate) int baudrate; { /* Convert baud rate to uart clock divider */ switch (baudrate) { case 38400: baudrate = 16; break; case 19200: baudrate = 33; break; case 9600: baudrate = 65; break; default: return -1; } set_timer_3(baudrate); /* Set it */ } #endif