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 | f0eb1f6 | 2012-09-12 13:50:56 +0200 | [diff] [blame] | 73 | |
Mike Frysinger | c52b4f7 | 2011-04-29 18:03:30 +0000 | [diff] [blame] | 74 | void serial_register(struct serial_device *dev) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 75 | { |
Wolfgang Denk | 2e5167c | 2010-10-28 20:00:11 +0200 | [diff] [blame] | 76 | #ifdef CONFIG_NEEDS_MANUAL_RELOC |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 77 | dev->start += gd->reloc_off; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 78 | dev->setbrg += gd->reloc_off; |
| 79 | dev->getc += gd->reloc_off; |
| 80 | dev->tstc += gd->reloc_off; |
| 81 | dev->putc += gd->reloc_off; |
| 82 | dev->puts += gd->reloc_off; |
Peter Tyser | 521af04 | 2009-09-21 11:20:36 -0500 | [diff] [blame] | 83 | #endif |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 84 | |
| 85 | dev->next = serial_devices; |
| 86 | serial_devices = dev; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 87 | } |
| 88 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 89 | void serial_initialize(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 90 | { |
Marek Vasut | f0eb1f6 | 2012-09-12 13:50:56 +0200 | [diff] [blame] | 91 | mpc8xx_serial_initialize(); |
Marek Vasut | abc0ed8 | 2012-09-12 20:02:05 +0200 | [diff] [blame] | 92 | ns16550_serial_initialize(); |
Marek Vasut | 1fe5c11 | 2012-09-12 13:57:58 +0200 | [diff] [blame] | 93 | pxa_serial_initialize(); |
Marek Vasut | 28af638 | 2012-09-12 16:01:16 +0200 | [diff] [blame] | 94 | s3c24xx_serial_initialize(); |
Marek Vasut | b498051 | 2012-09-12 19:39:57 +0200 | [diff] [blame] | 95 | s5p_serial_initialize(); |
Marek Vasut | 918327c | 2012-09-12 19:50:18 +0200 | [diff] [blame] | 96 | mpc512x_serial_initialize(); |
Marek Vasut | 5ae1de0 | 2012-09-12 20:07:54 +0200 | [diff] [blame] | 97 | bfin_serial_initialize(); |
Marek Vasut | 41651ca | 2012-09-13 00:02:54 +0200 | [diff] [blame] | 98 | bfin_jtag_initialize(); |
Marek Vasut | 87d6922 | 2012-09-12 19:45:58 +0200 | [diff] [blame] | 99 | uartlite_serial_initialize(); |
Tom Rini | 51d8102 | 2012-10-08 14:46:23 -0700 | [diff] [blame] | 100 | zynq_serial_initalize(); |
Marek Vasut | 7b953c5 | 2012-09-13 01:16:50 +0200 | [diff] [blame] | 101 | au1x00_serial_initialize(); |
Marek Vasut | 0191142 | 2012-09-13 01:20:07 +0200 | [diff] [blame] | 102 | asc_serial_initialize(); |
Marek Vasut | 6cb3273 | 2012-09-13 01:20:59 +0200 | [diff] [blame] | 103 | jz_serial_initialize(); |
Marek Vasut | b57c652 | 2012-09-13 01:26:42 +0200 | [diff] [blame] | 104 | mpc5xx_serial_initialize(); |
Marek Vasut | 2063a54 | 2012-09-13 01:29:31 +0200 | [diff] [blame] | 105 | mpc8220_serial_initialize(); |
Marek Vasut | d68f4da | 2012-09-13 01:34:16 +0200 | [diff] [blame] | 106 | mpc8260_scc_serial_initialize(); |
| 107 | mpc8260_smc_serial_initialize(); |
Marek Vasut | 7a31154 | 2012-09-13 01:38:52 +0200 | [diff] [blame] | 108 | mpc85xx_serial_initialize(); |
Marek Vasut | fcc2074 | 2012-09-13 01:40:33 +0200 | [diff] [blame] | 109 | iop480_serial_initialize(); |
Marek Vasut | af7be3b | 2012-09-13 12:25:07 +0200 | [diff] [blame] | 110 | leon2_serial_initialize(); |
Marek Vasut | 29b5ff7 | 2012-09-13 12:25:48 +0200 | [diff] [blame] | 111 | leon3_serial_initialize(); |
Marek Vasut | afe4c38 | 2012-09-13 12:26:39 +0200 | [diff] [blame] | 112 | marvell_serial_initialize(); |
Marek Vasut | 5dee6f5 | 2012-09-13 12:27:37 +0200 | [diff] [blame] | 113 | amirix_serial_initialize(); |
Marek Vasut | c45a14a | 2012-09-13 12:28:07 +0200 | [diff] [blame] | 114 | bmw_serial_initialize(); |
Marek Vasut | d25c39d | 2012-09-13 12:29:31 +0200 | [diff] [blame] | 115 | cogent_serial_initialize(); |
Marek Vasut | 619c90b | 2012-09-13 12:32:56 +0200 | [diff] [blame] | 116 | cpci750_serial_initialize(); |
Marek Vasut | 829b3b2 | 2012-09-13 12:33:50 +0200 | [diff] [blame] | 117 | evb64260_serial_initialize(); |
Marek Vasut | d126f28 | 2012-09-13 12:34:24 +0200 | [diff] [blame] | 118 | ml2_serial_initialize(); |
Marek Vasut | 26d8eaa | 2012-09-13 12:34:49 +0200 | [diff] [blame] | 119 | sconsole_serial_initialize(); |
Marek Vasut | 088a4f3 | 2012-09-13 12:35:54 +0200 | [diff] [blame^] | 120 | p3mx_serial_initialize(); |
Marek Vasut | 7b953c5 | 2012-09-13 01:16:50 +0200 | [diff] [blame] | 121 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 122 | serial_assign(default_serial_console()->name); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 123 | } |
| 124 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 125 | void serial_stdio_init(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 126 | { |
Jean-Christophe PLAGNIOL-VILLARD | 52cb4d4 | 2009-05-16 12:14:54 +0200 | [diff] [blame] | 127 | struct stdio_dev dev; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 128 | struct serial_device *s = serial_devices; |
| 129 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 130 | while (s) { |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 131 | memset(&dev, 0, sizeof(dev)); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 132 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 133 | strcpy(dev.name, s->name); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 134 | dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT; |
| 135 | |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 136 | dev.start = s->start; |
| 137 | dev.stop = s->stop; |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 138 | dev.putc = s->putc; |
| 139 | dev.puts = s->puts; |
| 140 | dev.getc = s->getc; |
| 141 | dev.tstc = s->tstc; |
| 142 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 143 | stdio_register(&dev); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 144 | |
| 145 | s = s->next; |
| 146 | } |
| 147 | } |
| 148 | |
Gerlando Falauto | 7813ca9 | 2011-11-18 06:49:12 +0000 | [diff] [blame] | 149 | int serial_assign(const char *name) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 150 | { |
| 151 | struct serial_device *s; |
| 152 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 153 | for (s = serial_devices; s; s = s->next) { |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 154 | if (strcmp(s->name, name) == 0) { |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 155 | serial_current = s; |
| 156 | return 0; |
| 157 | } |
| 158 | } |
| 159 | |
| 160 | return 1; |
| 161 | } |
| 162 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 163 | void serial_reinit_all(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 164 | { |
| 165 | struct serial_device *s; |
| 166 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 167 | for (s = serial_devices; s; s = s->next) |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 168 | s->start(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 169 | } |
| 170 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 171 | static struct serial_device *get_current(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 172 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 173 | struct serial_device *dev; |
| 174 | |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 175 | if (!(gd->flags & GD_FLG_RELOC) || !serial_current) { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 176 | dev = default_serial_console(); |
wdenk | 2ee6653 | 2004-10-11 22:43:02 +0000 | [diff] [blame] | 177 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 178 | /* We must have a console device */ |
| 179 | if (!dev) |
| 180 | panic("Cannot find console"); |
| 181 | } else |
| 182 | dev = serial_current; |
| 183 | return dev; |
| 184 | } |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 185 | |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 186 | int serial_init(void) |
| 187 | { |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 188 | return get_current()->start(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 189 | } |
| 190 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 191 | void serial_setbrg(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 192 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 193 | get_current()->setbrg(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 194 | } |
| 195 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 196 | int serial_getc(void) |
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 | return get_current()->getc(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 199 | } |
| 200 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 201 | int serial_tstc(void) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 202 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 203 | return get_current()->tstc(); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 204 | } |
| 205 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 206 | void serial_putc(const char c) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 207 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 208 | get_current()->putc(c); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 209 | } |
| 210 | |
Gerlando Falauto | a6e6f7f | 2011-11-18 06:49:11 +0000 | [diff] [blame] | 211 | void serial_puts(const char *s) |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 212 | { |
Simon Glass | 857c283 | 2011-08-19 11:09:43 +0000 | [diff] [blame] | 213 | get_current()->puts(s); |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 214 | } |
Mike Frysinger | 7b826c2 | 2011-05-14 06:56:15 +0000 | [diff] [blame] | 215 | |
| 216 | #if CONFIG_POST & CONFIG_SYS_POST_UART |
| 217 | static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE; |
| 218 | |
| 219 | /* Mark weak until post/cpu/.../uart.c migrate over */ |
| 220 | __weak |
| 221 | int uart_post_test(int flags) |
| 222 | { |
| 223 | unsigned char c; |
| 224 | int ret, saved_baud, b; |
| 225 | struct serial_device *saved_dev, *s; |
| 226 | bd_t *bd = gd->bd; |
| 227 | |
| 228 | /* Save current serial state */ |
| 229 | ret = 0; |
| 230 | saved_dev = serial_current; |
| 231 | saved_baud = bd->bi_baudrate; |
| 232 | |
| 233 | for (s = serial_devices; s; s = s->next) { |
| 234 | /* If this driver doesn't support loop back, skip it */ |
| 235 | if (!s->loop) |
| 236 | continue; |
| 237 | |
| 238 | /* Test the next device */ |
| 239 | serial_current = s; |
| 240 | |
| 241 | ret = serial_init(); |
| 242 | if (ret) |
| 243 | goto done; |
| 244 | |
| 245 | /* Consume anything that happens to be queued */ |
| 246 | while (serial_tstc()) |
| 247 | serial_getc(); |
| 248 | |
| 249 | /* Enable loop back */ |
| 250 | s->loop(1); |
| 251 | |
| 252 | /* Test every available baud rate */ |
| 253 | for (b = 0; b < ARRAY_SIZE(bauds); ++b) { |
| 254 | bd->bi_baudrate = bauds[b]; |
| 255 | serial_setbrg(); |
| 256 | |
| 257 | /* |
| 258 | * Stick to printable chars to avoid issues: |
| 259 | * - terminal corruption |
| 260 | * - serial program reacting to sequences and sending |
| 261 | * back random extra data |
| 262 | * - most serial drivers add in extra chars (like \r\n) |
| 263 | */ |
| 264 | for (c = 0x20; c < 0x7f; ++c) { |
| 265 | /* Send it out */ |
| 266 | serial_putc(c); |
| 267 | |
| 268 | /* Make sure it's the same one */ |
| 269 | ret = (c != serial_getc()); |
| 270 | if (ret) { |
| 271 | s->loop(0); |
| 272 | goto done; |
| 273 | } |
| 274 | |
| 275 | /* Clean up the output in case it was sent */ |
| 276 | serial_putc('\b'); |
| 277 | ret = ('\b' != serial_getc()); |
| 278 | if (ret) { |
| 279 | s->loop(0); |
| 280 | goto done; |
| 281 | } |
| 282 | } |
| 283 | } |
| 284 | |
| 285 | /* Disable loop back */ |
| 286 | s->loop(0); |
| 287 | |
Marek Vasut | 89143fb | 2012-09-07 14:35:31 +0200 | [diff] [blame] | 288 | /* XXX: There is no serial_stop() !? */ |
| 289 | if (s->stop) |
| 290 | s->stop(); |
Mike Frysinger | 7b826c2 | 2011-05-14 06:56:15 +0000 | [diff] [blame] | 291 | } |
| 292 | |
| 293 | done: |
| 294 | /* Restore previous serial state */ |
| 295 | serial_current = saved_dev; |
| 296 | bd->bi_baudrate = saved_baud; |
| 297 | serial_reinit_all(); |
| 298 | serial_setbrg(); |
| 299 | |
| 300 | return ret; |
| 301 | } |
| 302 | #endif |