PageRenderTime 24ms CodeModel.GetById 13ms app.highlight 8ms RepoModel.GetById 1ms app.codeStats 0ms

/arch/powerpc/boot/serial.c

https://github.com/aicjofs/android_kernel_lge_v500_20d_f2fs
C | 151 lines | 114 code | 20 blank | 17 comment | 44 complexity | e21e33888acb867ce8bfd2c481ecf6c5 MD5 | raw file
  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
 22static int serial_open(void)
 23{
 24	struct serial_console_data *scdp = console_ops.data;
 25	return scdp->open();
 26}
 27
 28static 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
 36static 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
 77static void serial_close(void)
 78{
 79	struct serial_console_data *scdp = console_ops.data;
 80
 81	if (scdp->close)
 82		scdp->close();
 83}
 84
 85static 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	}
104err_out:
105	return NULL;
106}
107
108static struct serial_console_data serial_cd;
109
110/* Node's "compatible" property determines which serial driver to use */
111int 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	}
149err_out:
150	return -1;
151}