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

嵌入式Linux

开发平台:

Unix_Linux

  1. #include <linux/config.h>
  2. #include <linux/kernel.h>
  3. #include <linux/console.h>
  4. #include <linux/string.h>
  5. #include <linux/init.h>
  6. #include <linux/delay.h>
  7. #include <linux/interrupt.h>
  8. #include <asm/page.h>
  9. #include <asm/types.h>
  10. #include <asm/system.h>
  11. #include <asm/pdc.h> /* for iodc_call() proto and friends */
  12. #include <asm/real.h>
  13. static int __attribute__((aligned(8)))   iodc_retbuf[32];
  14. static char __attribute__((aligned(64))) iodc_dbuf[4096];
  15. /*
  16.  * pdc_putc:
  17.  * Console character print using IODC.
  18.  *
  19.  * Note that only these special chars are architected for console IODC io:
  20.  * BEL, BS, CR, and LF. Others are passed through.
  21.  * Since the HP console requires CR+LF to perform a 'newline', we translate
  22.  * "n" to "rn".
  23.  */
  24. static int posx; /* for simple TAB-Simulation... */
  25. /* XXX Should we spinlock posx usage */
  26. void pdc_putc(unsigned char c)
  27. {
  28. unsigned int n;
  29. unsigned long flags;
  30. switch (c) {
  31. case 'n':
  32. iodc_dbuf[0] = 'r'; 
  33. iodc_dbuf[1] = 'n';
  34.                 n = 2;
  35.                 posx = 0;
  36. break;
  37. case 't':
  38. pdc_putc(' ');
  39. while (posx & 7)  /* expand TAB */
  40. pdc_putc(' ');
  41. return; /* return since IODC can't handle this */
  42. case 'b':
  43. posx-=2; /* BS */
  44. default:
  45. iodc_dbuf[0] = c;
  46. n = 1;
  47. posx++;
  48. break;
  49. }
  50. {
  51. real32_call(PAGE0->mem_cons.iodc_io,
  52. (unsigned long)PAGE0->mem_cons.hpa, ENTRY_IO_COUT,
  53. PAGE0->mem_cons.spa, __pa(PAGE0->mem_cons.dp.layers),
  54. __pa(iodc_retbuf), 0, __pa(iodc_dbuf), n, 0);
  55. }
  56. }
  57. static void pdc_console_write(struct console *co, const char *s, unsigned count)
  58. {
  59. while(count--)
  60. pdc_putc(*s++);
  61. }
  62. int pdc_console_wait_key(struct console *co)
  63. {
  64. int ch = 'X';
  65. int status;
  66. /* Bail if no console input device. */
  67. if (!PAGE0->mem_kbd.iodc_io)
  68. return 0;
  69. /* wait for a keyboard (rs232)-input */
  70. do {
  71. unsigned long flags;
  72. save_flags(flags);
  73. cli();
  74. status = real32_call(PAGE0->mem_kbd.iodc_io,
  75. (unsigned long)PAGE0->mem_kbd.hpa, ENTRY_IO_CIN,
  76. PAGE0->mem_kbd.spa, __pa(PAGE0->mem_kbd.dp.layers),
  77. __pa(iodc_retbuf), 0, __pa(iodc_dbuf), 1, 0);
  78. restore_flags(flags);
  79. ch = *iodc_dbuf; /* save the character directly to ch */
  80. } while (*iodc_retbuf == 0); /* wait for a key */
  81. return ch;
  82. }
  83. int pdc_getc(void)
  84. {
  85. return pdc_console_wait_key(NULL);
  86. }
  87. static int pdc_console_setup(struct console *co, char *options)
  88. {
  89. return 0;
  90. }
  91. static struct console pdc_cons = {
  92. name: "ttyB",
  93. write: pdc_console_write,
  94. read: NULL,
  95. device: NULL, 
  96. wait_key: pdc_console_wait_key,
  97. unblank: NULL,
  98. setup: pdc_console_setup,
  99. flags: CON_PRINTBUFFER|CON_ENABLED,  // |CON_CONSDEV,
  100. index: -1,
  101. };
  102. static int pdc_console_initialized;
  103. void pdc_console_init(void)
  104. {
  105. if (pdc_console_initialized)
  106. return;
  107. ++pdc_console_initialized;
  108. /* If the console is duplex then copy the COUT parameters to CIN. */
  109. if (PAGE0->mem_cons.cl_class == CL_DUPLEX)
  110. memcpy(&PAGE0->mem_kbd, &PAGE0->mem_cons, sizeof(PAGE0->mem_cons));
  111. pdc_console_write(0, "PDC Console Initializedn", 24);
  112. /* register the pdc console */
  113. register_console(&pdc_cons);
  114. }
  115. /* Unregister the pdc console with the printk console layer */
  116. void pdc_console_die(void)
  117. {
  118. printk("Switching from PDC consolen");
  119. if (!pdc_console_initialized)
  120. return;
  121. --pdc_console_initialized;
  122. #ifdef CONFIG_VT_CONSOLE
  123. schedule_console_callback();
  124. #endif
  125. unregister_console(&pdc_cons);
  126. }
  127. /*
  128.  * Used for emergencies. Currently only used if an HPMC occurs. If an
  129.  * HPMC occurs, it is possible that the current console may not be
  130.  * properly initialed after the PDC IO reset. This routine unregisters all
  131.  * of the current consoles, reinitializes the pdc console and
  132.  * registers it.
  133.  */
  134. void pdc_console_restart(void)
  135. {
  136. struct console *console;
  137. extern int log_size;
  138. if (pdc_console_initialized)
  139. return;
  140. while ((console = console_drivers) != (struct console *)0)
  141. unregister_console(console_drivers);
  142. log_size = 0;
  143. pdc_console_init();
  144. printk("Switched to PDC consolen");
  145. return;
  146. }