| /* |
| * (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); |
| |
| 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(); |
| 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 |