wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2004 |
| 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * |
| 5 | * See file CREDITS for list of people who contributed to this |
| 6 | * project. |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or |
| 9 | * modify it under the terms of the GNU General Public License as |
| 10 | * published by the Free Software Foundation; either version 2 of |
| 11 | * the License, or (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License |
| 19 | * along with this program; if not, write to the Free Software |
| 20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 21 | * MA 02111-1307 USA |
| 22 | */ |
| 23 | |
| 24 | #include <common.h> |
| 25 | #include <serial.h> |
Jean-Christophe PLAGNIOL-VILLARD | 52cb4d4 | 2009-05-16 12:14:54 +0200 | [diff] [blame] | 26 | #include <stdio_dev.h> |
Mike Frysinger | 7b826c2 | 2011-05-14 06:56:15 +0000 | [diff] [blame] | 27 | #include <post.h> |
| 28 | #include <linux/compiler.h> |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 29 | |
Wolfgang Denk | d87080b | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 30 | DECLARE_GLOBAL_DATA_PTR; |
| 31 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 32 | static struct serial_device *serial_devices; |
| 33 | static struct serial_device *serial_current; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 34 | |
Marek Vasut | 2a333ae | 2012-09-12 17:49:58 +0200 | [diff] [blame] | 35 | static void serial_null(void) |
| 36 | { |
| 37 | } |
| 38 | |
| 39 | #define serial_initfunc(name) \ |
| 40 | void name(void) \ |
| 41 | __attribute__((weak, alias("serial_null"))); |
| 42 | |
Marek Vasut | f0eb1f6 | 2012-09-12 13:50:56 +0200 | [diff] [blame] | 43 | serial_initfunc(mpc8xx_serial_initialize); |
Marek Vasut | abc0ed8 | 2012-09-12 20:02:05 +0200 | [diff] [blame] | 44 | serial_initfunc(ns16550_serial_initialize); |
Marek Vasut | 1fe5c11 | 2012-09-12 13:57:58 +0200 | [diff] [blame] | 45 | serial_initfunc(pxa_serial_initialize); |
Marek Vasut | 28af638 | 2012-09-12 16:01:16 +0200 | [diff] [blame] | 46 | serial_initfunc(s3c24xx_serial_initialize); |
Marek Vasut | b498051 | 2012-09-12 19:39:57 +0200 | [diff] [blame] | 47 | serial_initfunc(s5p_serial_initialize); |
Tom Rini | 51d8102 | 2012-10-08 14:46:23 -0700 | [diff] [blame] | 48 | serial_initfunc(zynq_serial_initalize); |
Marek Vasut | 5ae1de0 | 2012-09-12 20:07:54 +0200 | [diff] [blame] | 49 | serial_initfunc(bfin_serial_initialize); |
Marek Vasut | 41651ca | 2012-09-13 00:02:54 +0200 | [diff] [blame] | 50 | serial_initfunc(bfin_jtag_initialize); |
Marek Vasut | 918327c | 2012-09-12 19:50:18 +0200 | [diff] [blame] | 51 | serial_initfunc(mpc512x_serial_initialize); |
Marek Vasut | 87d6922 | 2012-09-12 19:45:58 +0200 | [diff] [blame] | 52 | serial_initfunc(uartlite_serial_initialize); |
Marek Vasut | 7b953c5 | 2012-09-13 01:16:50 +0200 | [diff] [blame] | 53 | serial_initfunc(au1x00_serial_initialize); |
Marek Vasut | 0191142 | 2012-09-13 01:20:07 +0200 | [diff] [blame] | 54 | serial_initfunc(asc_serial_initialize); |
Marek Vasut | 6cb3273 | 2012-09-13 01:20:59 +0200 | [diff] [blame] | 55 | serial_initfunc(jz_serial_initialize); |
Marek Vasut | b57c652 | 2012-09-13 01:26:42 +0200 | [diff] [blame] | 56 | serial_initfunc(mpc5xx_serial_initialize); |
Marek Vasut | 2063a54 | 2012-09-13 01:29:31 +0200 | [diff] [blame] | 57 | serial_initfunc(mpc8220_serial_initialize); |
Marek Vasut | d68f4da | 2012-09-13 01:34:16 +0200 | [diff] [blame] | 58 | serial_initfunc(mpc8260_scc_serial_initialize); |
| 59 | serial_initfunc(mpc8260_smc_serial_initialize); |
Marek Vasut | 7a31154 | 2012-09-13 01:38:52 +0200 | [diff] [blame] | 60 | serial_initfunc(mpc85xx_serial_initialize); |
Marek Vasut | fcc2074 | 2012-09-13 01:40:33 +0200 | [diff] [blame] | 61 | serial_initfunc(iop480_serial_initialize); |
Marek Vasut | af7be3b | 2012-09-13 12:25:07 +0200 | [diff] [blame] | 62 | serial_initfunc(leon2_serial_initialize); |
Marek Vasut | 29b5ff7 | 2012-09-13 12:25:48 +0200 | [diff] [blame] | 63 | serial_initfunc(leon3_serial_initialize); |
Marek Vasut | afe4c38 | 2012-09-13 12:26:39 +0200 | [diff] [blame] | 64 | serial_initfunc(marvell_serial_initialize); |
Marek Vasut | 5dee6f5 | 2012-09-13 12:27:37 +0200 | [diff] [blame] | 65 | serial_initfunc(amirix_serial_initialize); |
Marek Vasut | c45a14a | 2012-09-13 12:28:07 +0200 | [diff] [blame] | 66 | serial_initfunc(bmw_serial_initialize); |
Marek Vasut | d25c39d | 2012-09-13 12:29:31 +0200 | [diff] [blame] | 67 | serial_initfunc(cogent_serial_initialize); |
Marek Vasut | 619c90b | 2012-09-13 12:32:56 +0200 | [diff] [blame] | 68 | serial_initfunc(cpci750_serial_initialize); |
Marek Vasut | 829b3b2 | 2012-09-13 12:33:50 +0200 | [diff] [blame] | 69 | serial_initfunc(evb64260_serial_initialize); |
Marek Vasut | d126f28 | 2012-09-13 12:34:24 +0200 | [diff] [blame] | 70 | serial_initfunc(ml2_serial_initialize); |
Marek Vasut | 26d8eaa | 2012-09-13 12:34:49 +0200 | [diff] [blame] | 71 | serial_initfunc(sconsole_serial_initialize); |
Marek Vasut | 088a4f3 | 2012-09-13 12:35:54 +0200 | [diff] [blame] | 72 | serial_initfunc(p3mx_serial_initialize); |
Marek Vasut | 8c08575 | 2012-09-13 16:48:50 +0200 | [diff] [blame] | 73 | serial_initfunc(altera_jtag_serial_initialize); |
Marek Vasut | b207d64 | 2012-09-13 16:49:51 +0200 | [diff] [blame] | 74 | serial_initfunc(altera_serial_initialize); |
Marek Vasut | cfba457 | 2012-09-13 16:50:30 +0200 | [diff] [blame] | 75 | serial_initfunc(atmel_serial_initialize); |
Marek Vasut | e503f90 | 2012-09-13 16:51:02 +0200 | [diff] [blame] | 76 | serial_initfunc(lpc32xx_serial_initialize); |
Marek Vasut | abaef69 | 2012-09-13 16:51:38 +0200 | [diff] [blame] | 77 | serial_initfunc(mcf_serial_initialize); |
Marek Vasut | 28ea4c3 | 2012-09-13 16:52:07 +0200 | [diff] [blame^] | 78 | serial_initfunc(ns9750_serial_initialize); |
Marek Vasut | f0eb1f6 | 2012-09-12 13:50:56 +0200 | [diff] [blame] | 79 | |
Mike Frysinger | c52b4f7 | 2011-04-29 18:03:30 +0000 | [diff] [blame] | 80 | void serial_register(struct serial_device *dev) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 81 | { |
Wolfgang Denk | 2e5167c | 2010-10-28 20:00:11 +0200 | [diff] [blame] | 82 | #ifdef CONFIG_NEEDS_MANUAL_RELOC |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 83 | dev->start += gd->reloc_off; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 84 | dev->setbrg += gd->reloc_off; |
| 85 | dev->getc += gd->reloc_off; |
| 86 | dev->tstc += gd->reloc_off; |
| 87 | dev->putc += gd->reloc_off; |
| 88 | dev->puts += gd->reloc_off; |
Peter Tyser | 521af04 | 2009-09-21 11:20:36 -0500 | [diff] [blame] | 89 | #endif |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 90 | |
| 91 | dev->next = serial_devices; |
| 92 | serial_devices = dev; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 93 | } |
| 94 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 95 | void serial_initialize(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 96 | { |
Marek Vasut | f0eb1f6 | 2012-09-12 13:50:56 +0200 | [diff] [blame] | 97 | mpc8xx_serial_initialize(); |
Marek Vasut | abc0ed8 | 2012-09-12 20:02:05 +0200 | [diff] [blame] | 98 | ns16550_serial_initialize(); |
Marek Vasut | 1fe5c11 | 2012-09-12 13:57:58 +0200 | [diff] [blame] | 99 | pxa_serial_initialize(); |
Marek Vasut | 28af638 | 2012-09-12 16:01:16 +0200 | [diff] [blame] | 100 | s3c24xx_serial_initialize(); |
Marek Vasut | b498051 | 2012-09-12 19:39:57 +0200 | [diff] [blame] | 101 | s5p_serial_initialize(); |
Marek Vasut | 918327c | 2012-09-12 19:50:18 +0200 | [diff] [blame] | 102 | mpc512x_serial_initialize(); |
Marek Vasut | 5ae1de0 | 2012-09-12 20:07:54 +0200 | [diff] [blame] | 103 | bfin_serial_initialize(); |
Marek Vasut | 41651ca | 2012-09-13 00:02:54 +0200 | [diff] [blame] | 104 | bfin_jtag_initialize(); |
Marek Vasut | 87d6922 | 2012-09-12 19:45:58 +0200 | [diff] [blame] | 105 | uartlite_serial_initialize(); |
Tom Rini | 51d8102 | 2012-10-08 14:46:23 -0700 | [diff] [blame] | 106 | zynq_serial_initalize(); |
Marek Vasut | 7b953c5 | 2012-09-13 01:16:50 +0200 | [diff] [blame] | 107 | au1x00_serial_initialize(); |
Marek Vasut | 0191142 | 2012-09-13 01:20:07 +0200 | [diff] [blame] | 108 | asc_serial_initialize(); |
Marek Vasut | 6cb3273 | 2012-09-13 01:20:59 +0200 | [diff] [blame] | 109 | jz_serial_initialize(); |
Marek Vasut | b57c652 | 2012-09-13 01:26:42 +0200 | [diff] [blame] | 110 | mpc5xx_serial_initialize(); |
Marek Vasut | 2063a54 | 2012-09-13 01:29:31 +0200 | [diff] [blame] | 111 | mpc8220_serial_initialize(); |
Marek Vasut | d68f4da | 2012-09-13 01:34:16 +0200 | [diff] [blame] | 112 | mpc8260_scc_serial_initialize(); |
| 113 | mpc8260_smc_serial_initialize(); |
Marek Vasut | 7a31154 | 2012-09-13 01:38:52 +0200 | [diff] [blame] | 114 | mpc85xx_serial_initialize(); |
Marek Vasut | fcc2074 | 2012-09-13 01:40:33 +0200 | [diff] [blame] | 115 | iop480_serial_initialize(); |
Marek Vasut | af7be3b | 2012-09-13 12:25:07 +0200 | [diff] [blame] | 116 | leon2_serial_initialize(); |
Marek Vasut | 29b5ff7 | 2012-09-13 12:25:48 +0200 | [diff] [blame] | 117 | leon3_serial_initialize(); |
Marek Vasut | afe4c38 | 2012-09-13 12:26:39 +0200 | [diff] [blame] | 118 | marvell_serial_initialize(); |
Marek Vasut | 5dee6f5 | 2012-09-13 12:27:37 +0200 | [diff] [blame] | 119 | amirix_serial_initialize(); |
Marek Vasut | c45a14a | 2012-09-13 12:28:07 +0200 | [diff] [blame] | 120 | bmw_serial_initialize(); |
Marek Vasut | d25c39d | 2012-09-13 12:29:31 +0200 | [diff] [blame] | 121 | cogent_serial_initialize(); |
Marek Vasut | 619c90b | 2012-09-13 12:32:56 +0200 | [diff] [blame] | 122 | cpci750_serial_initialize(); |
Marek Vasut | 829b3b2 | 2012-09-13 12:33:50 +0200 | [diff] [blame] | 123 | evb64260_serial_initialize(); |
Marek Vasut | d126f28 | 2012-09-13 12:34:24 +0200 | [diff] [blame] | 124 | ml2_serial_initialize(); |
Marek Vasut | 26d8eaa | 2012-09-13 12:34:49 +0200 | [diff] [blame] | 125 | sconsole_serial_initialize(); |
Marek Vasut | 088a4f3 | 2012-09-13 12:35:54 +0200 | [diff] [blame] | 126 | p3mx_serial_initialize(); |
Marek Vasut | 8c08575 | 2012-09-13 16:48:50 +0200 | [diff] [blame] | 127 | altera_jtag_serial_initialize(); |
Marek Vasut | b207d64 | 2012-09-13 16:49:51 +0200 | [diff] [blame] | 128 | altera_serial_initialize(); |
Marek Vasut | cfba457 | 2012-09-13 16:50:30 +0200 | [diff] [blame] | 129 | atmel_serial_initialize(); |
Marek Vasut | e503f90 | 2012-09-13 16:51:02 +0200 | [diff] [blame] | 130 | lpc32xx_serial_initialize(); |
Marek Vasut | abaef69 | 2012-09-13 16:51:38 +0200 | [diff] [blame] | 131 | mcf_serial_initialize(); |
Marek Vasut | 28ea4c3 | 2012-09-13 16:52:07 +0200 | [diff] [blame^] | 132 | ns9750_serial_initialize(); |
Marek Vasut | 7b953c5 | 2012-09-13 01:16:50 +0200 | [diff] [blame] | 133 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 134 | serial_assign(default_serial_console()->name); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 135 | } |
| 136 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 137 | void serial_stdio_init(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 138 | { |
Jean-Christophe PLAGNIOL-VILLARD | 52cb4d4 | 2009-05-16 12:14:54 +0200 | [diff] [blame] | 139 | struct stdio_dev dev; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 140 | struct serial_device *s = serial_devices; |
| 141 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 142 | while (s) { |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 143 | memset(&dev, 0, sizeof(dev)); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 144 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 145 | strcpy(dev.name, s->name); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 146 | dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT; |
| 147 | |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 148 | dev.start = s->start; |
| 149 | dev.stop = s->stop; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 150 | dev.putc = s->putc; |
| 151 | dev.puts = s->puts; |
| 152 | dev.getc = s->getc; |
| 153 | dev.tstc = s->tstc; |
| 154 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 155 | stdio_register(&dev); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 156 | |
| 157 | s = s->next; |
| 158 | } |
| 159 | } |
| 160 | |
Gerlando Falauto | 7813ca9 | 2011-11-18 06:49:12 +0000 | [diff] [blame] | 161 | int serial_assign(const char *name) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 162 | { |
| 163 | struct serial_device *s; |
| 164 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 165 | for (s = serial_devices; s; s = s->next) { |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 166 | if (strcmp(s->name, name) == 0) { |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 167 | serial_current = s; |
| 168 | return 0; |
| 169 | } |
| 170 | } |
| 171 | |
| 172 | return 1; |
| 173 | } |
| 174 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 175 | void serial_reinit_all(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 176 | { |
| 177 | struct serial_device *s; |
| 178 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 179 | for (s = serial_devices; s; s = s->next) |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 180 | s->start(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 181 | } |
| 182 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 183 | static struct serial_device *get_current(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 184 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 185 | struct serial_device *dev; |
| 186 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 187 | if (!(gd->flags & GD_FLG_RELOC) || !serial_current) { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 188 | dev = default_serial_console(); |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 189 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 190 | /* We must have a console device */ |
| 191 | if (!dev) |
| 192 | panic("Cannot find console"); |
| 193 | } else |
| 194 | dev = serial_current; |
| 195 | return dev; |
| 196 | } |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 197 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 198 | int serial_init(void) |
| 199 | { |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 200 | return get_current()->start(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 201 | } |
| 202 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 203 | void serial_setbrg(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 204 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 205 | get_current()->setbrg(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 206 | } |
| 207 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 208 | int serial_getc(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 209 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 210 | return get_current()->getc(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 211 | } |
| 212 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 213 | int serial_tstc(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 214 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 215 | return get_current()->tstc(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 216 | } |
| 217 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 218 | void serial_putc(const char c) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 219 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 220 | get_current()->putc(c); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 221 | } |
| 222 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 223 | void serial_puts(const char *s) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 224 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 225 | get_current()->puts(s); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 226 | } |
Mike Frysinger | 7b826c2 | 2011-05-14 06:56:15 +0000 | [diff] [blame] | 227 | |
| 228 | #if CONFIG_POST & CONFIG_SYS_POST_UART |
| 229 | static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE; |
| 230 | |
| 231 | /* Mark weak until post/cpu/.../uart.c migrate over */ |
| 232 | __weak |
| 233 | int uart_post_test(int flags) |
| 234 | { |
| 235 | unsigned char c; |
| 236 | int ret, saved_baud, b; |
| 237 | struct serial_device *saved_dev, *s; |
| 238 | bd_t *bd = gd->bd; |
| 239 | |
| 240 | /* Save current serial state */ |
| 241 | ret = 0; |
| 242 | saved_dev = serial_current; |
| 243 | saved_baud = bd->bi_baudrate; |
| 244 | |
| 245 | for (s = serial_devices; s; s = s->next) { |
| 246 | /* If this driver doesn't support loop back, skip it */ |
| 247 | if (!s->loop) |
| 248 | continue; |
| 249 | |
| 250 | /* Test the next device */ |
| 251 | serial_current = s; |
| 252 | |
| 253 | ret = serial_init(); |
| 254 | if (ret) |
| 255 | goto done; |
| 256 | |
| 257 | /* Consume anything that happens to be queued */ |
| 258 | while (serial_tstc()) |
| 259 | serial_getc(); |
| 260 | |
| 261 | /* Enable loop back */ |
| 262 | s->loop(1); |
| 263 | |
| 264 | /* Test every available baud rate */ |
| 265 | for (b = 0; b < ARRAY_SIZE(bauds); ++b) { |
| 266 | bd->bi_baudrate = bauds[b]; |
| 267 | serial_setbrg(); |
| 268 | |
| 269 | /* |
| 270 | * Stick to printable chars to avoid issues: |
| 271 | * - terminal corruption |
| 272 | * - serial program reacting to sequences and sending |
| 273 | * back random extra data |
| 274 | * - most serial drivers add in extra chars (like \r\n) |
| 275 | */ |
| 276 | for (c = 0x20; c < 0x7f; ++c) { |
| 277 | /* Send it out */ |
| 278 | serial_putc(c); |
| 279 | |
| 280 | /* Make sure it's the same one */ |
| 281 | ret = (c != serial_getc()); |
| 282 | if (ret) { |
| 283 | s->loop(0); |
| 284 | goto done; |
| 285 | } |
| 286 | |
| 287 | /* Clean up the output in case it was sent */ |
| 288 | serial_putc('\b'); |
| 289 | ret = ('\b' != serial_getc()); |
| 290 | if (ret) { |
| 291 | s->loop(0); |
| 292 | goto done; |
| 293 | } |
| 294 | } |
| 295 | } |
| 296 | |
| 297 | /* Disable loop back */ |
| 298 | s->loop(0); |
| 299 | |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 300 | /* XXX: There is no serial_stop() !? */ |
| 301 | if (s->stop) |
| 302 | s->stop(); |
Mike Frysinger | 7b826c2 | 2011-05-14 06:56:15 +0000 | [diff] [blame] | 303 | } |
| 304 | |
| 305 | done: |
| 306 | /* Restore previous serial state */ |
| 307 | serial_current = saved_dev; |
| 308 | bd->bi_baudrate = saved_baud; |
| 309 | serial_reinit_all(); |
| 310 | serial_setbrg(); |
| 311 | |
| 312 | return ret; |
| 313 | } |
| 314 | #endif |