prom.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:4k
- /* 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 idprom *idprom;
- static struct idprom idprom_buffer;
- struct linux_romvec *romvec;
- /* prom vector table */
- e_vector *sun3x_prom_vbr;
- extern e_vector vectors[256]; /* arch/m68k/kernel/traps.c */
- /* Handle returning to the prom */
- void sun3x_halt(void)
- {
- unsigned long flags;
-
- /* Disable interrupts while we mess with things */
- save_flags(flags); cli();
- /* 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));
- restore_flags(flags);
- }
- void sun3x_reboot(void)
- {
- /* This never returns, don't bother saving things */
- cli();
- /* 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 = {
- "debug",
- sun3x_prom_write, /* write */
- NULL, /* read */
- NULL, /* device */
- NULL, /* unblank */
- NULL, /* setup */
- CON_PRINTBUFFER,
- -1,
- 0,
- NULL
- };
- void sun3x_prom_init(void)
- {
- /* Read the vector table */
- int i;
- 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;
- /* make a copy of the idprom structure */
- for(i = 0; i < sizeof(struct idprom); i++)
- ((unsigned char *)(&idprom_buffer))[i] = ((unsigned char *)SUN3X_IDPROM)[i];
- idprom = &idprom_buffer;
- if((idprom->id_machtype & SM_ARCH_MASK) != SM_SUN3X) {
- printk("Warning: machine reports strange type %02xn",
- 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();
- }