prom.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* Prom access routines for the sun3x */
  2. #include <linux/types.h>
  3. #include <linux/kernel.h>
  4. #include <linux/tty.h>
  5. #include <linux/console.h>
  6. #include <linux/init.h>
  7. #include <linux/mm.h>
  8. #include <linux/string.h>
  9. #include <asm/page.h>
  10. #include <asm/pgtable.h>
  11. #include <asm/bootinfo.h>
  12. #include <asm/setup.h>
  13. #include <asm/traps.h>
  14. #include <asm/sun3xprom.h>
  15. #include <asm/idprom.h>
  16. #include <asm/segment.h>
  17. #include <asm/sun3ints.h>
  18. #include <asm/openprom.h>
  19. #include <asm/machines.h>
  20. void (*sun3x_putchar)(int);
  21. int (*sun3x_getchar)(void);
  22. int (*sun3x_mayget)(void);
  23. int (*sun3x_mayput)(int);
  24. void (*sun3x_prom_reboot)(void);
  25. e_vector sun3x_prom_abort;
  26. struct idprom *idprom;
  27. static struct idprom idprom_buffer;
  28. struct linux_romvec *romvec;
  29. /* prom vector table */
  30. e_vector *sun3x_prom_vbr;
  31. extern e_vector vectors[256];  /* arch/m68k/kernel/traps.c */
  32. /* Handle returning to the prom */
  33. void sun3x_halt(void)
  34. {
  35.     unsigned long flags;
  36.     
  37.     /* Disable interrupts while we mess with things */
  38.     save_flags(flags); cli();
  39.     /* Restore prom vbr */
  40.     __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));
  41.     /* Restore prom NMI clock */
  42. //    sun3x_disable_intreg(5);
  43.     sun3_enable_irq(7);
  44.     /* Let 'er rip */
  45.     __asm__ volatile ("trap #14" : : );
  46.     /* Restore everything */
  47.     sun3_disable_irq(7);
  48.     sun3_enable_irq(5);
  49.     __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)vectors));
  50.     restore_flags(flags);
  51. }
  52. void sun3x_reboot(void)
  53. {
  54.     /* This never returns, don't bother saving things */
  55.     cli();
  56.     /* Restore prom vbr */
  57.     __asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));
  58.     /* Restore prom NMI clock */
  59.     sun3_disable_irq(5);
  60.     sun3_enable_irq(7);
  61.     /* Let 'er rip */
  62.     (*romvec->pv_reboot)("vmlinux");
  63. }
  64. extern char m68k_debug_device[];
  65. static void sun3x_prom_write(struct console *co, const char *s,
  66.                              unsigned int count)
  67. {
  68.     while (count--) {
  69.         if (*s == 'n')
  70.             sun3x_putchar('r');
  71.         sun3x_putchar(*s++);
  72.     }
  73. }
  74. /* debug console - write-only */
  75. static struct console sun3x_debug = {
  76. "debug",
  77. sun3x_prom_write,   /* write */
  78. NULL, /* read */
  79. NULL, /* device */
  80. NULL, /* wait_key */
  81. NULL, /* unblank */
  82. NULL, /* setup */
  83. CON_PRINTBUFFER,
  84. -1,
  85. 0,
  86. NULL
  87. };
  88. void sun3x_prom_init(void)
  89. {
  90.     /* Read the vector table */
  91. int i;
  92.     sun3x_putchar = *(void (**)(int)) (SUN3X_P_PUTCHAR);
  93.     sun3x_getchar = *(int (**)(void)) (SUN3X_P_GETCHAR);
  94.     sun3x_mayget = *(int (**)(void))  (SUN3X_P_MAYGET);
  95.     sun3x_mayput = *(int (**)(int))   (SUN3X_P_MAYPUT);
  96.     sun3x_prom_reboot = *(void (**)(void)) (SUN3X_P_REBOOT);
  97.     sun3x_prom_abort = *(e_vector *)  (SUN3X_P_ABORT);
  98.     romvec = (struct linux_romvec *)SUN3X_PROM_BASE;
  99.     /* make a copy of the idprom structure */
  100.     for(i = 0; i < sizeof(struct idprom); i++) 
  101.     ((unsigned char *)(&idprom_buffer))[i] = ((unsigned char *)SUN3X_IDPROM)[i];
  102.     idprom = &idprom_buffer;
  103.     if((idprom->id_machtype & SM_ARCH_MASK) != SM_SUN3X) {
  104.     printk("Warning: machine reports strange type %02xn");
  105.     printk("Pretending it's a 3/80, but very afraid...n");
  106.     idprom->id_machtype = SM_SUN3X | SM_3_80;
  107.     }
  108.     /* point trap #14 at abort.
  109.      * XXX this is futile since we restore the vbr first - oops
  110.      */
  111.     vectors[VEC_TRAP14] = sun3x_prom_abort;
  112.     
  113.     /* If debug=prom was specified, start the debug console */
  114.     if (!strcmp(m68k_debug_device, "prom"))
  115.         register_console(&sun3x_debug);
  116.     
  117. }
  118. /* some prom functions to export */
  119. int prom_getintdefault(int node, char *property, int deflt)
  120. {
  121. return deflt;
  122. }
  123. int prom_getbool (int node, char *prop)
  124. {
  125. return 1;
  126. }
  127. void prom_printf(char *fmt, ...)
  128. {
  129. }
  130. void prom_halt (void)
  131. {
  132. sun3x_halt();
  133. }