common/serial.c - filogic/uboot - Gitiles

 /*
  * (C) Copyright 2004
  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  *
  * See file CREDITS for list of people who contributed to this
  * project.
  *
  * This program is free software; you can redistribute it and/or
  * modify it under the terms of the GNU General Public License as
  * published by the Free Software Foundation; either version 2 of
  * the License, or (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
  *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  * MA 02111-1307 USA
  */

 #include <common.h>
 #include <serial.h>
 #include <stdio_dev.h>
 #include <post.h>
 #include <linux/compiler.h>

 DECLARE_GLOBAL_DATA_PTR;

 static struct serial_device *serial_devices;
 static struct serial_device *serial_current;

 static void serial_null(void)
 {
 }

 #define serial_initfunc(name)					\
 	void name(void)						\
 		__attribute__((weak, alias("serial_null")));

 serial_initfunc(mpc8xx_serial_initialize);
 serial_initfunc(ns16550_serial_initialize);
 serial_initfunc(pxa_serial_initialize);
 serial_initfunc(s3c24xx_serial_initialize);
 serial_initfunc(s5p_serial_initialize);
 serial_initfunc(zynq_serial_initalize);
 serial_initfunc(bfin_serial_initialize);
 serial_initfunc(bfin_jtag_initialize);
 serial_initfunc(mpc512x_serial_initialize);
 serial_initfunc(uartlite_serial_initialize);
 serial_initfunc(au1x00_serial_initialize);
 serial_initfunc(asc_serial_initialize);
 serial_initfunc(jz_serial_initialize);
 serial_initfunc(mpc5xx_serial_initialize);
 serial_initfunc(mpc8220_serial_initialize);
 serial_initfunc(mpc8260_scc_serial_initialize);
 serial_initfunc(mpc8260_smc_serial_initialize);
 serial_initfunc(mpc85xx_serial_initialize);
 serial_initfunc(iop480_serial_initialize);
 serial_initfunc(leon2_serial_initialize);
 serial_initfunc(leon3_serial_initialize);
 serial_initfunc(marvell_serial_initialize);
 serial_initfunc(amirix_serial_initialize);
 serial_initfunc(bmw_serial_initialize);
 serial_initfunc(cogent_serial_initialize);
 serial_initfunc(cpci750_serial_initialize);
 serial_initfunc(evb64260_serial_initialize);
 serial_initfunc(ml2_serial_initialize);
 serial_initfunc(sconsole_serial_initialize);
 serial_initfunc(p3mx_serial_initialize);
 serial_initfunc(altera_jtag_serial_initialize);
 serial_initfunc(altera_serial_initialize);
 serial_initfunc(atmel_serial_initialize);
 serial_initfunc(lpc32xx_serial_initialize);
 serial_initfunc(mcf_serial_initialize);
 serial_initfunc(ns9750_serial_initialize);
 serial_initfunc(oc_serial_initialize);
 serial_initfunc(s3c4510b_serial_initialize);
 serial_initfunc(s3c64xx_serial_initialize);
 serial_initfunc(sandbox_serial_initialize);
 serial_initfunc(clps7111_serial_initialize);
 serial_initfunc(imx_serial_initialize);
 serial_initfunc(ixp_serial_initialize);
 serial_initfunc(ks8695_serial_initialize);
 serial_initfunc(lh7a40x_serial_initialize);
 serial_initfunc(lpc2292_serial_initialize);

 void serial_register(struct serial_device *dev)
 {
 #ifdef CONFIG_NEEDS_MANUAL_RELOC
 	dev->start += gd->reloc_off;
 	dev->setbrg += gd->reloc_off;
 	dev->getc += gd->reloc_off;
 	dev->tstc += gd->reloc_off;
 	dev->putc += gd->reloc_off;
 	dev->puts += gd->reloc_off;
 #endif

 	dev->next = serial_devices;
 	serial_devices = dev;
 }

 void serial_initialize(void)
 {
 	mpc8xx_serial_initialize();
 	ns16550_serial_initialize();
 	pxa_serial_initialize();
 	s3c24xx_serial_initialize();
 	s5p_serial_initialize();
 	mpc512x_serial_initialize();
 	bfin_serial_initialize();
 	bfin_jtag_initialize();
 	uartlite_serial_initialize();
 	zynq_serial_initalize();
 	au1x00_serial_initialize();
 	asc_serial_initialize();
 	jz_serial_initialize();
 	mpc5xx_serial_initialize();
 	mpc8220_serial_initialize();
 	mpc8260_scc_serial_initialize();
 	mpc8260_smc_serial_initialize();
 	mpc85xx_serial_initialize();
 	iop480_serial_initialize();
 	leon2_serial_initialize();
 	leon3_serial_initialize();
 	marvell_serial_initialize();
 	amirix_serial_initialize();
 	bmw_serial_initialize();
 	cogent_serial_initialize();
 	cpci750_serial_initialize();
 	evb64260_serial_initialize();
 	ml2_serial_initialize();
 	sconsole_serial_initialize();
 	p3mx_serial_initialize();
 	altera_jtag_serial_initialize();
 	altera_serial_initialize();
 	atmel_serial_initialize();
 	lpc32xx_serial_initialize();
 	mcf_serial_initialize();
 	ns9750_serial_initialize();
 	oc_serial_initialize();
 	s3c4510b_serial_initialize();
 	s3c64xx_serial_initialize();
 	sandbox_serial_initialize();
 	clps7111_serial_initialize();
 	imx_serial_initialize();
 	ixp_serial_initialize();
 	ks8695_serial_initialize();
 	lh7a40x_serial_initialize();
 	lpc2292_serial_initialize();

 	serial_assign(default_serial_console()->name);
 }

 void serial_stdio_init(void)
 {
 	struct stdio_dev dev;
 	struct serial_device *s = serial_devices;

 	while (s) {
 		memset(&dev, 0, sizeof(dev));

 		strcpy(dev.name, s->name);
 		dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;

 		dev.start = s->start;
 		dev.stop = s->stop;
 		dev.putc = s->putc;
 		dev.puts = s->puts;
 		dev.getc = s->getc;
 		dev.tstc = s->tstc;

 		stdio_register(&dev);

 		s = s->next;
 	}
 }

 int serial_assign(const char *name)
 {
 	struct serial_device *s;

 	for (s = serial_devices; s; s = s->next) {
 		if (strcmp(s->name, name) == 0) {
 			serial_current = s;
 			return 0;
 		}
 	}

 	return 1;
 }

 void serial_reinit_all(void)
 {
 	struct serial_device *s;

 	for (s = serial_devices; s; s = s->next)
 		s->start();
 }

 static struct serial_device *get_current(void)
 {
 	struct serial_device *dev;

 	if (!(gd->flags & GD_FLG_RELOC) || !serial_current) {
 		dev = default_serial_console();

 		/* We must have a console device */
 		if (!dev)
 			panic("Cannot find console");
 	} else
 		dev = serial_current;
 	return dev;
 }

 int serial_init(void)
 {
 	return get_current()->start();
 }

 void serial_setbrg(void)
 {
 	get_current()->setbrg();
 }

 int serial_getc(void)
 {
 	return get_current()->getc();
 }

 int serial_tstc(void)
 {
 	return get_current()->tstc();
 }

 void serial_putc(const char c)
 {
 	get_current()->putc(c);
 }

 void serial_puts(const char *s)
 {
 	get_current()->puts(s);
 }

 #if CONFIG_POST & CONFIG_SYS_POST_UART
 static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE;

 /* Mark weak until post/cpu/.../uart.c migrate over */
 __weak
 int uart_post_test(int flags)
 {
 	unsigned char c;
 	int ret, saved_baud, b;
 	struct serial_device *saved_dev, *s;
 	bd_t *bd = gd->bd;

 	/* Save current serial state */
 	ret = 0;
 	saved_dev = serial_current;
 	saved_baud = bd->bi_baudrate;

 	for (s = serial_devices; s; s = s->next) {
 		/* If this driver doesn't support loop back, skip it */
 		if (!s->loop)
 			continue;

 		/* Test the next device */
 		serial_current = s;

 		ret = serial_init();
 		if (ret)
 			goto done;

 		/* Consume anything that happens to be queued */
 		while (serial_tstc())
 			serial_getc();

 		/* Enable loop back */
 		s->loop(1);

 		/* Test every available baud rate */
 		for (b = 0; b < ARRAY_SIZE(bauds); ++b) {
 			bd->bi_baudrate = bauds[b];
 			serial_setbrg();

 			/*
 			 * Stick to printable chars to avoid issues:
 			 *  - terminal corruption
 			 *  - serial program reacting to sequences and sending
 			 *    back random extra data
 			 *  - most serial drivers add in extra chars (like \r\n)
 			 */
 			for (c = 0x20; c < 0x7f; ++c) {
 				/* Send it out */
 				serial_putc(c);

 				/* Make sure it's the same one */
 				ret = (c != serial_getc());
 				if (ret) {
 					s->loop(0);
 					goto done;
 				}

 				/* Clean up the output in case it was sent */
 				serial_putc('\b');
 				ret = ('\b' != serial_getc());
 				if (ret) {
 					s->loop(0);
 					goto done;
 				}
 			}
 		}

 		/* Disable loop back */
 		s->loop(0);

 		/* XXX: There is no serial_stop() !? */
 		if (s->stop)
 			s->stop();
 	}

  done:
 	/* Restore previous serial state */
 	serial_current = saved_dev;
 	bd->bi_baudrate = saved_baud;
 	serial_reinit_all();
 	serial_setbrg();

 	return ret;
 }
 #endif
	/*
	* (C) Copyright 2004
	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	*
	* See file CREDITS for list of people who contributed to this
	* project.
	*
	* This program is free software; you can redistribute it and/or
	* modify it under the terms of the GNU General Public License as
	* published by the Free Software Foundation; either version 2 of
	* the License, or (at your option) any later version.
	*
	* This program is distributed in the hope that it will be useful,
	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	* GNU General Public License for more details.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program; if not, write to the Free Software
	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	* MA 02111-1307 USA
	*/

	#include <common.h>
	#include <serial.h>
	#include <stdio_dev.h>
	#include <post.h>
	#include <linux/compiler.h>

	DECLARE_GLOBAL_DATA_PTR;

	static struct serial_device *serial_devices;
	static struct serial_device *serial_current;

	static void serial_null(void)
	{
	}

	#define serial_initfunc(name) \
	void name(void) \
	__attribute__((weak, alias("serial_null")));

	serial_initfunc(mpc8xx_serial_initialize);
	serial_initfunc(ns16550_serial_initialize);
	serial_initfunc(pxa_serial_initialize);
	serial_initfunc(s3c24xx_serial_initialize);
	serial_initfunc(s5p_serial_initialize);
	serial_initfunc(zynq_serial_initalize);
	serial_initfunc(bfin_serial_initialize);
	serial_initfunc(bfin_jtag_initialize);
	serial_initfunc(mpc512x_serial_initialize);
	serial_initfunc(uartlite_serial_initialize);
	serial_initfunc(au1x00_serial_initialize);
	serial_initfunc(asc_serial_initialize);
	serial_initfunc(jz_serial_initialize);
	serial_initfunc(mpc5xx_serial_initialize);
	serial_initfunc(mpc8220_serial_initialize);
	serial_initfunc(mpc8260_scc_serial_initialize);
	serial_initfunc(mpc8260_smc_serial_initialize);
	serial_initfunc(mpc85xx_serial_initialize);
	serial_initfunc(iop480_serial_initialize);
	serial_initfunc(leon2_serial_initialize);
	serial_initfunc(leon3_serial_initialize);
	serial_initfunc(marvell_serial_initialize);
	serial_initfunc(amirix_serial_initialize);
	serial_initfunc(bmw_serial_initialize);
	serial_initfunc(cogent_serial_initialize);
	serial_initfunc(cpci750_serial_initialize);
	serial_initfunc(evb64260_serial_initialize);
	serial_initfunc(ml2_serial_initialize);
	serial_initfunc(sconsole_serial_initialize);
	serial_initfunc(p3mx_serial_initialize);
	serial_initfunc(altera_jtag_serial_initialize);
	serial_initfunc(altera_serial_initialize);
	serial_initfunc(atmel_serial_initialize);
	serial_initfunc(lpc32xx_serial_initialize);
	serial_initfunc(mcf_serial_initialize);
	serial_initfunc(ns9750_serial_initialize);
	serial_initfunc(oc_serial_initialize);
	serial_initfunc(s3c4510b_serial_initialize);
	serial_initfunc(s3c64xx_serial_initialize);
	serial_initfunc(sandbox_serial_initialize);
	serial_initfunc(clps7111_serial_initialize);
	serial_initfunc(imx_serial_initialize);
	serial_initfunc(ixp_serial_initialize);
	serial_initfunc(ks8695_serial_initialize);
	serial_initfunc(lh7a40x_serial_initialize);
	serial_initfunc(lpc2292_serial_initialize);

	void serial_register(struct serial_device *dev)
	{
	#ifdef CONFIG_NEEDS_MANUAL_RELOC
	dev->start += gd->reloc_off;
	dev->setbrg += gd->reloc_off;
	dev->getc += gd->reloc_off;
	dev->tstc += gd->reloc_off;
	dev->putc += gd->reloc_off;
	dev->puts += gd->reloc_off;
	#endif

	dev->next = serial_devices;
	serial_devices = dev;
	}

	void serial_initialize(void)
	{
	mpc8xx_serial_initialize();
	ns16550_serial_initialize();
	pxa_serial_initialize();
	s3c24xx_serial_initialize();
	s5p_serial_initialize();
	mpc512x_serial_initialize();
	bfin_serial_initialize();
	bfin_jtag_initialize();
	uartlite_serial_initialize();
	zynq_serial_initalize();
	au1x00_serial_initialize();
	asc_serial_initialize();
	jz_serial_initialize();
	mpc5xx_serial_initialize();
	mpc8220_serial_initialize();
	mpc8260_scc_serial_initialize();
	mpc8260_smc_serial_initialize();
	mpc85xx_serial_initialize();
	iop480_serial_initialize();
	leon2_serial_initialize();
	leon3_serial_initialize();
	marvell_serial_initialize();
	amirix_serial_initialize();
	bmw_serial_initialize();
	cogent_serial_initialize();
	cpci750_serial_initialize();
	evb64260_serial_initialize();
	ml2_serial_initialize();
	sconsole_serial_initialize();
	p3mx_serial_initialize();
	altera_jtag_serial_initialize();
	altera_serial_initialize();
	atmel_serial_initialize();
	lpc32xx_serial_initialize();
	mcf_serial_initialize();
	ns9750_serial_initialize();
	oc_serial_initialize();
	s3c4510b_serial_initialize();
	s3c64xx_serial_initialize();
	sandbox_serial_initialize();
	clps7111_serial_initialize();
	imx_serial_initialize();
	ixp_serial_initialize();
	ks8695_serial_initialize();
	lh7a40x_serial_initialize();
	lpc2292_serial_initialize();

	serial_assign(default_serial_console()->name);
	}

	void serial_stdio_init(void)
	{
	struct stdio_dev dev;
	struct serial_device *s = serial_devices;

	while (s) {
	memset(&dev, 0, sizeof(dev));

	strcpy(dev.name, s->name);
	dev.flags = DEV_FLAGS_OUTPUT \| DEV_FLAGS_INPUT;

	dev.start = s->start;
	dev.stop = s->stop;
	dev.putc = s->putc;
	dev.puts = s->puts;
	dev.getc = s->getc;
	dev.tstc = s->tstc;

	stdio_register(&dev);

	s = s->next;
	}
	}

	int serial_assign(const char *name)
	{
	struct serial_device *s;

	for (s = serial_devices; s; s = s->next) {
	if (strcmp(s->name, name) == 0) {
	serial_current = s;
	return 0;
	}
	}

	return 1;
	}

	void serial_reinit_all(void)
	{
	struct serial_device *s;

	for (s = serial_devices; s; s = s->next)
	s->start();
	}

	static struct serial_device *get_current(void)
	{
	struct serial_device *dev;

	if (!(gd->flags & GD_FLG_RELOC) \|\| !serial_current) {
	dev = default_serial_console();

	/* We must have a console device */
	if (!dev)
	panic("Cannot find console");
	} else
	dev = serial_current;
	return dev;
	}

	int serial_init(void)
	{
	return get_current()->start();
	}

	void serial_setbrg(void)
	{
	get_current()->setbrg();
	}

	int serial_getc(void)
	{
	return get_current()->getc();
	}

	int serial_tstc(void)
	{
	return get_current()->tstc();
	}

	void serial_putc(const char c)
	{
	get_current()->putc(c);
	}

	void serial_puts(const char *s)
	{
	get_current()->puts(s);
	}

	#if CONFIG_POST & CONFIG_SYS_POST_UART
	static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE;

	/* Mark weak until post/cpu/.../uart.c migrate over */
	__weak
	int uart_post_test(int flags)
	{
	unsigned char c;
	int ret, saved_baud, b;
	struct serial_device saved_dev, s;
	bd_t *bd = gd->bd;

	/* Save current serial state */
	ret = 0;
	saved_dev = serial_current;
	saved_baud = bd->bi_baudrate;

	for (s = serial_devices; s; s = s->next) {
	/* If this driver doesn't support loop back, skip it */
	if (!s->loop)
	continue;

	/* Test the next device */
	serial_current = s;

	ret = serial_init();
	if (ret)
	goto done;

	/* Consume anything that happens to be queued */
	while (serial_tstc())
	serial_getc();

	/* Enable loop back */
	s->loop(1);

	/* Test every available baud rate */
	for (b = 0; b < ARRAY_SIZE(bauds); ++b) {
	bd->bi_baudrate = bauds[b];
	serial_setbrg();

	/*
	* Stick to printable chars to avoid issues:
	* - terminal corruption
	* - serial program reacting to sequences and sending
	* back random extra data
	* - most serial drivers add in extra chars (like \r\n)
	*/
	for (c = 0x20; c < 0x7f; ++c) {
	/* Send it out */
	serial_putc(c);

	/* Make sure it's the same one */
	ret = (c != serial_getc());
	if (ret) {
	s->loop(0);
	goto done;
	}

	/* Clean up the output in case it was sent */
	serial_putc('\b');
	ret = ('\b' != serial_getc());
	if (ret) {
	s->loop(0);
	goto done;
	}
	}
	}

	/* Disable loop back */
	s->loop(0);

	/* XXX: There is no serial_stop() !? */
	if (s->stop)
	s->stop();
	}

	done:
	/* Restore previous serial state */
	serial_current = saved_dev;
	bd->bi_baudrate = saved_baud;
	serial_reinit_all();
	serial_setbrg();

	return ret;
	}
	#endif