mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-20 08:58:52 +09:00
![Marek Vasut](/assets/img/avatar_default.png)
Enhance the manual relocation of drivers operations structure by checking if the entries are NULL and increment them only if they are not. This allows for setting any entry to NULL and it will survive the manual relocation. Signed-off-by: Marek Vasut <marex@denx.de> Cc: Marek Vasut <marek.vasut@gmail.com> Cc: Tom Rini <trini@ti.com> Cc: Anatolij Gustschin <agust@denx.de> Cc: Stefan Roese <sr@denx.de>
363 lines
8.7 KiB
C
363 lines
8.7 KiB
C
/*
|
|
* (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);
|
|
serial_initfunc(max3100_serial_initialize);
|
|
serial_initfunc(mxc_serial_initialize);
|
|
serial_initfunc(netarm_serial_initialize);
|
|
serial_initfunc(pl01x_serial_initialize);
|
|
serial_initfunc(s3c44b0_serial_initialize);
|
|
serial_initfunc(sa1100_serial_initialize);
|
|
serial_initfunc(sh_serial_initialize);
|
|
|
|
void serial_register(struct serial_device *dev)
|
|
{
|
|
#ifdef CONFIG_NEEDS_MANUAL_RELOC
|
|
if (dev->start)
|
|
dev->start += gd->reloc_off;
|
|
if (dev->stop)
|
|
dev->stop += gd->reloc_off;
|
|
if (dev->setbrg)
|
|
dev->setbrg += gd->reloc_off;
|
|
if (dev->getc)
|
|
dev->getc += gd->reloc_off;
|
|
if (dev->tstc)
|
|
dev->tstc += gd->reloc_off;
|
|
if (dev->putc)
|
|
dev->putc += gd->reloc_off;
|
|
if (dev->puts)
|
|
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();
|
|
max3100_serial_initialize();
|
|
mxc_serial_initialize();
|
|
netarm_serial_initialize();
|
|
pl01x_serial_initialize();
|
|
s3c44b0_serial_initialize();
|
|
sa1100_serial_initialize();
|
|
sh_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) {
|
|
#ifdef CONFIG_SPL_BUILD
|
|
puts("Cannot find console\n");
|
|
hang();
|
|
#else
|
|
panic("Cannot find console\n");
|
|
#endif
|
|
}
|
|
} 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
|