Commit | Line | Data |
---|---|---|
0c176fa8 MG |
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 | ||
0c176fa8 MG |
22 | static int serial_open(void) |
23 | { | |
24 | struct serial_console_data *scdp = console_ops.data; | |
25 | return scdp->open(); | |
26 | } | |
27 | ||
b96fbb6e | 28 | static void serial_write(const char *buf, int len) |
0c176fa8 MG |
29 | { |
30 | struct serial_console_data *scdp = console_ops.data; | |
31 | ||
32 | while (*buf != '\0') | |
33 | scdp->putc(*buf++); | |
34 | } | |
35 | ||
4b4b13d5 | 36 | static void serial_edit_cmdline(char *buf, int len, unsigned int timeout) |
0c176fa8 MG |
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 | ||
4b4b13d5 | 47 | do { |
0c176fa8 MG |
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 */ | |
4b4b13d5 | 73 | } while (timer++ < timeout); |
0c176fa8 MG |
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; | |
0c176fa8 MG |
115 | |
116 | devp = serial_get_stdout_devp(); | |
117 | if (devp == NULL) | |
118 | goto err_out; | |
119 | ||
8f23735d GP |
120 | if (dt_is_compatible(devp, "ns16550") || |
121 | dt_is_compatible(devp, "pnpPNP,501")) | |
0c176fa8 | 122 | rc = ns16550_console_init(devp, &serial_cd); |
a1810b44 | 123 | else if (dt_is_compatible(devp, "marvell,mv64360-mpsc")) |
e12deb84 | 124 | rc = mpsc_console_init(devp, &serial_cd); |
d0f53faf SW |
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); | |
24ce6bc4 | 130 | else if (dt_is_compatible(devp, "fsl,mpc5200-psc-uart")) |
85498ae8 | 131 | rc = mpc5200_psc_console_init(devp, &serial_cd); |
c35a8fb2 SN |
132 | else if (dt_is_compatible(devp, "xlnx,opb-uartlite-1.00.b") || |
133 | dt_is_compatible(devp, "xlnx,xps-uartlite-1.00.a")) | |
7ddc5f97 | 134 | rc = uartlite_console_init(devp, &serial_cd); |
656ad58e OH |
135 | else if (dt_is_compatible(devp, "ibm,opal-console-raw")) |
136 | rc = opal_console_init(devp, &serial_cd); | |
0c176fa8 MG |
137 | |
138 | /* Add other serial console driver calls here */ | |
139 | ||
140 | if (!rc) { | |
141 | console_ops.open = serial_open; | |
142 | console_ops.write = serial_write; | |
0c176fa8 MG |
143 | console_ops.close = serial_close; |
144 | console_ops.data = &serial_cd; | |
145 | ||
dc4f397d SW |
146 | if (serial_cd.getc) |
147 | console_ops.edit_cmdline = serial_edit_cmdline; | |
148 | ||
0c176fa8 MG |
149 | return 0; |
150 | } | |
151 | err_out: | |
152 | return -1; | |
153 | } |