/* Prom access routines for the sun3x */ #include <linux/types.h> #include <linux/kernel.h> #include <linux/tty.h> #include <linux/console.h> #include <linux/init.h> #include <linux/mm.h> #include <linux/string.h> #include <asm/page.h> #include <asm/pgtable.h> #include <asm/bootinfo.h> #include <asm/setup.h> #include <asm/traps.h> #include <asm/sun3xprom.h> #include <asm/idprom.h> #include <asm/segment.h> #include <asm/sun3ints.h> #include <asm/openprom.h> #include <asm/machines.h> void (*sun3x_putchar)(int); int (*sun3x_getchar)(void); int (*sun3x_mayget)(void); int (*sun3x_mayput)(int); void (*sun3x_prom_reboot)(void); e_vector sun3x_prom_abort; struct linux_romvec *romvec; /* prom vector table */ e_vector *sun3x_prom_vbr; /* Handle returning to the prom */ void sun3x_halt(void) { unsigned long flags; /* Disable interrupts while we mess with things */ local_irq_save(flags); /* Restore prom vbr */ __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); /* Restore prom NMI clock */ // sun3x_disable_intreg(5); sun3_enable_irq(7); /* Let 'er rip */ __asm__ volatile ("trap #14" : : ); /* Restore everything */ sun3_disable_irq(7); sun3_enable_irq(5); __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)vectors)); local_irq_restore(flags); } void sun3x_reboot(void) { /* This never returns, don't bother saving things */ local_irq_disable(); /* Restore prom vbr */ __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr)); /* Restore prom NMI clock */ sun3_disable_irq(5); sun3_enable_irq(7); /* Let 'er rip */ (*romvec->pv_reboot)("vmlinux"); } extern char m68k_debug_device[]; static void sun3x_prom_write(struct console *co, const char *s, unsigned int count) { while (count--) { if (*s == '\n') sun3x_putchar('\r'); sun3x_putchar(*s++); } } /* debug console - write-only */ static struct console sun3x_debug = { .name = "debug", .write = sun3x_prom_write, .flags = CON_PRINTBUFFER, .index = -1, }; void sun3x_prom_init(void) { /* Read the vector table */ sun3x_putchar = *(void (**)(int)) (SUN3X_P_PUTCHAR); sun3x_getchar = *(int (**)(void)) (SUN3X_P_GETCHAR); sun3x_mayget = *(int (**)(void)) (SUN3X_P_MAYGET); sun3x_mayput = *(int (**)(int)) (SUN3X_P_MAYPUT); sun3x_prom_reboot = *(void (**)(void)) (SUN3X_P_REBOOT); sun3x_prom_abort = *(e_vector *) (SUN3X_P_ABORT); romvec = (struct linux_romvec *)SUN3X_PROM_BASE; idprom_init(); if(!((idprom->id_machtype & SM_ARCH_MASK) == SM_SUN3X)) { printk("Warning: machine reports strange type %02x\n", idprom->id_machtype); printk("Pretending it's a 3/80, but very afraid...\n"); idprom->id_machtype = SM_SUN3X | SM_3_80; } /* point trap #14 at abort. * XXX this is futile since we restore the vbr first - oops */ vectors[VEC_TRAP14] = sun3x_prom_abort; /* If debug=prom was specified, start the debug console */ if (!strcmp(m68k_debug_device, "prom")) register_console(&sun3x_debug); } /* some prom functions to export */ int prom_getintdefault(int node, char *property, int deflt) { return deflt; } int prom_getbool (int node, char *prop) { return 1; } void prom_printf(char *fmt, ...) { } void prom_halt (void) { sun3x_halt(); } /* Get the idprom and stuff it into buffer 'idbuf'. Returns the * format type. 'num_bytes' is the number of bytes that your idbuf * has space for. Returns 0xff on error. */ unsigned char prom_get_idprom(char *idbuf, int num_bytes) { int i; /* make a copy of the idprom structure */ for(i = 0; i < num_bytes; i++) idbuf[i] = ((char *)SUN3X_IDPROM)[i]; return idbuf[0]; }