treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / powerpc / boot / serial.c
blob9457863147f9b2d9dbdc470dfc6446d99cf4c4c8
1 /*
2 * Generic serial console support
4 * Author: Mark A. Greer <mgreer@mvista.com>
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>.
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.
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"
22 static int serial_open(void)
24 struct serial_console_data *scdp = console_ops.data;
25 return scdp->open();
28 static void serial_write(const char *buf, int len)
30 struct serial_console_data *scdp = console_ops.data;
32 while (*buf != '\0')
33 scdp->putc(*buf++);
36 static void serial_edit_cmdline(char *buf, int len, unsigned int timeout)
38 int timer = 0, count;
39 char ch, *cp;
40 struct serial_console_data *scdp = console_ops.data;
42 cp = buf;
43 count = strlen(buf);
44 cp = &buf[count];
45 count++;
47 do {
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");
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");
64 } else if (count < len) {
65 *cp++ = ch;
66 count++;
67 scdp->putc(ch);
70 break; /* Exit 'timer' loop */
72 udelay(1000); /* 1 msec */
73 } while (timer++ < timeout);
74 *cp = 0;
77 static void serial_close(void)
79 struct serial_console_data *scdp = console_ops.data;
81 if (scdp->close)
82 scdp->close();
85 static void *serial_get_stdout_devp(void)
87 void *devp;
88 char devtype[MAX_PROP_LEN];
89 char path[MAX_PATH_LEN];
91 devp = finddevice("/chosen");
92 if (devp == NULL)
93 goto err_out;
95 if (getprop(devp, "linux,stdout-path", path, MAX_PATH_LEN) > 0 ||
96 getprop(devp, "stdout-path", path, MAX_PATH_LEN) > 0) {
97 devp = finddevice(path);
98 if (devp == NULL)
99 goto err_out;
101 if ((getprop(devp, "device_type", devtype, sizeof(devtype)) > 0)
102 && !strcmp(devtype, "serial"))
103 return devp;
105 err_out:
106 return NULL;
109 static struct serial_console_data serial_cd;
111 /* Node's "compatible" property determines which serial driver to use */
112 int serial_console_init(void)
114 void *devp;
115 int rc = -1;
117 devp = serial_get_stdout_devp();
118 if (devp == NULL)
119 goto err_out;
121 if (dt_is_compatible(devp, "ns16550") ||
122 dt_is_compatible(devp, "pnpPNP,501"))
123 rc = ns16550_console_init(devp, &serial_cd);
124 #ifdef CONFIG_CPM
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 #endif
131 #ifdef CONFIG_PPC_MPC52XX
132 else if (dt_is_compatible(devp, "fsl,mpc5200-psc-uart"))
133 rc = mpc5200_psc_console_init(devp, &serial_cd);
134 #endif
135 #ifdef CONFIG_XILINX_VIRTEX
136 else if (dt_is_compatible(devp, "xlnx,opb-uartlite-1.00.b") ||
137 dt_is_compatible(devp, "xlnx,xps-uartlite-1.00.a"))
138 rc = uartlite_console_init(devp, &serial_cd);
139 #endif
140 #ifdef CONFIG_PPC64_BOOT_WRAPPER
141 else if (dt_is_compatible(devp, "ibm,opal-console-raw"))
142 rc = opal_console_init(devp, &serial_cd);
143 #endif
145 /* Add other serial console driver calls here */
147 if (!rc) {
148 console_ops.open = serial_open;
149 console_ops.write = serial_write;
150 console_ops.close = serial_close;
151 console_ops.data = &serial_cd;
153 if (serial_cd.getc)
154 console_ops.edit_cmdline = serial_edit_cmdline;
156 return 0;
158 err_out:
159 return -1;