This commit was manufactured by cvs2svn to create branch 'vserver'.

[linux-2.6.git] / arch / powerpc / boot / serial.c

diff --git a/arch/powerpc/boot/serial.c b/arch/powerpc/boot/serial.c
new file mode 100644 (file)
index 0000000..e8de4cf
--- /dev/null
+++ b/arch/powerpc/boot/serial.c
@@ -0,0 +1,142 @@
+/*
+ * Generic serial console support
+ *
+ * Author: Mark A. Greer <mgreer@mvista.com>
+ *
+ * Code in serial_edit_cmdline() copied from <file:arch/ppc/boot/simple/misc.c>
+ * and was written by Matt Porter <mporter@kernel.crashing.org>.
+ *
+ * 2001,2006 (c) MontaVista Software, Inc.  This file is licensed under
+ * the terms of the GNU General Public License version 2.  This program
+ * is licensed "as is" without any warranty of any kind, whether express
+ * or implied.
+ */
+#include <stdarg.h>
+#include <stddef.h>
+#include "types.h"
+#include "string.h"
+#include "stdio.h"
+#include "io.h"
+#include "ops.h"
+
+extern void udelay(long delay);
+
+static int serial_open(void)
+{
+       struct serial_console_data *scdp = console_ops.data;
+       return scdp->open();
+}
+
+static void serial_write(char *buf, int len)
+{
+       struct serial_console_data *scdp = console_ops.data;
+
+       while (*buf != '\0')
+               scdp->putc(*buf++);
+}
+
+static void serial_edit_cmdline(char *buf, int len)
+{
+       int timer = 0, count;
+       char ch, *cp;
+       struct serial_console_data *scdp = console_ops.data;
+
+       cp = buf;
+       count = strlen(buf);
+       cp = &buf[count];
+       count++;
+
+       while (timer++ < 5*1000) {
+               if (scdp->tstc()) {
+                       while (((ch = scdp->getc()) != '\n') && (ch != '\r')) {
+                               /* Test for backspace/delete */
+                               if ((ch == '\b') || (ch == '\177')) {
+                                       if (cp != buf) {
+                                               cp--;
+                                               count--;
+                                               printf("\b \b");
+                                       }
+                               /* Test for ^x/^u (and wipe the line) */
+                               } else if ((ch == '\030') || (ch == '\025')) {
+                                       while (cp != buf) {
+                                               cp--;
+                                               count--;
+                                               printf("\b \b");
+                                       }
+                               } else if (count < len) {
+                                               *cp++ = ch;
+                                               count++;
+                                               scdp->putc(ch);
+                               }
+                       }
+                       break;  /* Exit 'timer' loop */
+               }
+               udelay(1000);  /* 1 msec */
+       }
+       *cp = 0;
+}
+
+static void serial_close(void)
+{
+       struct serial_console_data *scdp = console_ops.data;
+
+       if (scdp->close)
+               scdp->close();
+}
+
+static void *serial_get_stdout_devp(void)
+{
+       void *devp;
+       char devtype[MAX_PROP_LEN];
+       char path[MAX_PATH_LEN];
+
+       devp = finddevice("/chosen");
+       if (devp == NULL)
+               goto err_out;
+
+       if (getprop(devp, "linux,stdout-path", path, MAX_PATH_LEN) > 0) {
+               devp = finddevice(path);
+               if (devp == NULL)
+                       goto err_out;
+
+               if ((getprop(devp, "device_type", devtype, sizeof(devtype)) > 0)
+                               && !strcmp(devtype, "serial"))
+                       return devp;
+       }
+err_out:
+       return NULL;
+}
+
+static struct serial_console_data serial_cd;
+
+/* Node's "compatible" property determines which serial driver to use */
+int serial_console_init(void)
+{
+       void *devp;
+       int rc = -1;
+       char compat[MAX_PROP_LEN];
+
+       devp = serial_get_stdout_devp();
+       if (devp == NULL)
+               goto err_out;
+
+       if (getprop(devp, "compatible", compat, sizeof(compat)) < 0)
+               goto err_out;
+
+       if (!strcmp(compat, "ns16550"))
+               rc = ns16550_console_init(devp, &serial_cd);
+
+       /* Add other serial console driver calls here */
+
+       if (!rc) {
+               console_ops.open = serial_open;
+               console_ops.write = serial_write;
+               console_ops.edit_cmdline = serial_edit_cmdline;
+               console_ops.close = serial_close;
+               console_ops.data = &serial_cd;
+
+               return 0;
+       }
+err_out:
+       return -1;
+}