release/src-rt-6.x.4708/linux/linux-2.6.36/arch/powerpc/boot/serial.c

   1 /*
   2  * Generic serial console support
   3  *
   4  * Author: Mark A. Greer <mgreer@mvista.com>
   5  *
   6  * Code in serial_edit_cmdline() copied from <file:arch/ppc/boot/simple/misc.c>
   7  * and was written by Matt Porter <mporter@kernel.crashing.org>.
   8  *
   9  * 2001,2006 (c) MontaVista Software, Inc.  This file is licensed under
  10  * the terms of the GNU General Public License version 2.  This program
  11  * is licensed "as is" without any warranty of any kind, whether express
  12  * or implied.
  13  */
  14 #include <stdarg.h>
  15 #include <stddef.h>
  16 #include "types.h"
  17 #include "string.h"
  18 #include "stdio.h"
  19 #include "io.h"
  20 #include "ops.h"
  21
  22 static int serial_open(void)
  23 {
  24         struct serial_console_data *scdp = console_ops.data;
  25         return scdp->open();
  26 }
  27
  28 static void serial_write(const char *buf, int len)
  29 {
  30         struct serial_console_data *scdp = console_ops.data;
  31
  32         while (*buf != '\0')
  33                 scdp->putc(*buf++);
  34 }
  35
  36 static void serial_edit_cmdline(char *buf, int len)
  37 {
  38         int timer = 0, count;
  39         char ch, *cp;
  40         struct serial_console_data *scdp = console_ops.data;
  41
  42         cp = buf;
  43         count = strlen(buf);
  44         cp = &buf[count];
  45         count++;
  46
  47         while (timer++ < 5*1000) {
  48                 if (scdp->tstc()) {
  49                         while (((ch = scdp->getc()) != '\n') && (ch != '\r')) {
  50                                 /* Test for backspace/delete */
  51                                 if ((ch == '\b') || (ch == '\177')) {
  52                                         if (cp != buf) {
  53                                                 cp--;
  54                                                 count--;
  55                                                 printf("\b \b");
  56                                         }
  57                                 /* Test for ^x/^u (and wipe the line) */
  58                                 } else if ((ch == '\030') || (ch == '\025')) {
  59                                         while (cp != buf) {
  60                                                 cp--;
  61                                                 count--;
  62                                                 printf("\b \b");
  63                                         }
  64                                 } else if (count < len) {
  65                                                 *cp++ = ch;
  66                                                 count++;
  67                                                 scdp->putc(ch);
  68                                 }
  69                         }
  70                         break;  /* Exit 'timer' loop */
  71                 }
  72                 udelay(1000);  /* 1 msec */
  73         }
  74         *cp = 0;
  75 }
  76
  77 static void serial_close(void)
  78 {
  79         struct serial_console_data *scdp = console_ops.data;
  80
  81         if (scdp->close)
  82                 scdp->close();
  83 }
  84
  85 static void *serial_get_stdout_devp(void)
  86 {
  87         void *devp;
  88         char devtype[MAX_PROP_LEN];
  89         char path[MAX_PATH_LEN];
  90
  91         devp = finddevice("/chosen");
  92         if (devp == NULL)
  93                 goto err_out;
  94
  95         if (getprop(devp, "linux,stdout-path", path, MAX_PATH_LEN) > 0) {
  96                 devp = finddevice(path);
  97                 if (devp == NULL)
  98                         goto err_out;
  99
 100                 if ((getprop(devp, "device_type", devtype, sizeof(devtype)) > 0)
 101                                 && !strcmp(devtype, "serial"))
 102                         return devp;
 103         }
 104 err_out:
 105         return NULL;
 106 }
 107
 108 static struct serial_console_data serial_cd;
 109
 110 /* Node's "compatible" property determines which serial driver to use */
 111 int serial_console_init(void)
 112 {
 113         void *devp;
 114         int rc = -1;
 115
 116         devp = serial_get_stdout_devp();
 117         if (devp == NULL)
 118                 goto err_out;
 119
 120         if (dt_is_compatible(devp, "ns16550") ||
 121             dt_is_compatible(devp, "pnpPNP,501"))
 122                 rc = ns16550_console_init(devp, &serial_cd);
 123         else if (dt_is_compatible(devp, "marvell,mv64360-mpsc"))
 124                 rc = mpsc_console_init(devp, &serial_cd);
 125         else if (dt_is_compatible(devp, "fsl,cpm1-scc-uart") ||
 126                  dt_is_compatible(devp, "fsl,cpm1-smc-uart") ||
 127                  dt_is_compatible(devp, "fsl,cpm2-scc-uart") ||
 128                  dt_is_compatible(devp, "fsl,cpm2-smc-uart"))
 129                 rc = cpm_console_init(devp, &serial_cd);
 130         else if (dt_is_compatible(devp, "fsl,mpc5200-psc-uart"))
 131                 rc = mpc5200_psc_console_init(devp, &serial_cd);
 132         else if (dt_is_compatible(devp, "xlnx,opb-uartlite-1.00.b") ||
 133                  dt_is_compatible(devp, "xlnx,xps-uartlite-1.00.a"))
 134                 rc = uartlite_console_init(devp, &serial_cd);
 135
 136         /* Add other serial console driver calls here */
 137
 138         if (!rc) {
 139                 console_ops.open = serial_open;
 140                 console_ops.write = serial_write;
 141                 console_ops.close = serial_close;
 142                 console_ops.data = &serial_cd;
 143
 144                 if (serial_cd.getc)
 145                         console_ops.edit_cmdline = serial_edit_cmdline;
 146
 147                 return 0;
 148         }
 149 err_out:
 150         return -1;
 151 }