blob: 397c6f520300d186660983a7dd6ccc7aefbf5353 [file] [log] [blame]
wdenk7ac16102004-08-01 22:48:16 +00001/*
2 * (C) Copyright 2004
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4 *
Wolfgang Denkd79de1d2013-07-08 09:37:19 +02005 * SPDX-License-Identifier: GPL-2.0+
wdenk7ac16102004-08-01 22:48:16 +00006 */
7
8#include <common.h>
Joe Hershberger3928bb62012-12-11 22:16:27 -06009#include <environment.h>
wdenk7ac16102004-08-01 22:48:16 +000010#include <serial.h>
Jean-Christophe PLAGNIOL-VILLARD2a7a0312009-05-16 12:14:54 +020011#include <stdio_dev.h>
Mike Frysinger078f2f12011-05-14 06:56:15 +000012#include <post.h>
13#include <linux/compiler.h>
Marek Vasut0e1b5772012-10-06 14:07:03 +000014#include <errno.h>
wdenk7ac16102004-08-01 22:48:16 +000015
Wolfgang Denk6405a152006-03-31 18:32:53 +020016DECLARE_GLOBAL_DATA_PTR;
17
Gerlando Falauto34148d62011-11-18 06:49:11 +000018static struct serial_device *serial_devices;
19static struct serial_device *serial_current;
Joe Hershberger3928bb62012-12-11 22:16:27 -060020/*
21 * Table with supported baudrates (defined in config_xyz.h)
22 */
23static const unsigned long baudrate_table[] = CONFIG_SYS_BAUDRATE_TABLE;
wdenk7ac16102004-08-01 22:48:16 +000024
Marek Vasut95656ea2012-10-08 11:36:39 +000025/**
26 * serial_null() - Void registration routine of a serial driver
27 *
28 * This routine implements a void registration routine of a serial
29 * driver. The registration routine of a particular driver is aliased
30 * to this empty function in case the driver is not compiled into
31 * U-Boot.
32 */
Marek Vasutf6af0482012-09-12 17:49:58 +020033static void serial_null(void)
34{
Joe Hershberger3928bb62012-12-11 22:16:27 -060035}
36
37/**
38 * on_baudrate() - Update the actual baudrate when the env var changes
39 *
40 * This will check for a valid baudrate and only apply it if valid.
41 */
42static int on_baudrate(const char *name, const char *value, enum env_op op,
43 int flags)
44{
45 int i;
46 int baudrate;
47
48 switch (op) {
49 case env_op_create:
50 case env_op_overwrite:
51 /*
52 * Switch to new baudrate if new baudrate is supported
53 */
54 baudrate = simple_strtoul(value, NULL, 10);
55
56 /* Not actually changing */
57 if (gd->baudrate == baudrate)
58 return 0;
59
Axel Linebca8732013-06-23 00:46:41 +080060 for (i = 0; i < ARRAY_SIZE(baudrate_table); ++i) {
Joe Hershberger3928bb62012-12-11 22:16:27 -060061 if (baudrate == baudrate_table[i])
62 break;
63 }
Axel Linebca8732013-06-23 00:46:41 +080064 if (i == ARRAY_SIZE(baudrate_table)) {
Joe Hershberger3928bb62012-12-11 22:16:27 -060065 if ((flags & H_FORCE) == 0)
66 printf("## Baudrate %d bps not supported\n",
67 baudrate);
68 return 1;
69 }
70 if ((flags & H_INTERACTIVE) != 0) {
71 printf("## Switch baudrate to %d"
72 " bps and press ENTER ...\n", baudrate);
73 udelay(50000);
74 }
75
76 gd->baudrate = baudrate;
Joe Hershberger3928bb62012-12-11 22:16:27 -060077
78 serial_setbrg();
79
80 udelay(50000);
81
82 if ((flags & H_INTERACTIVE) != 0)
83 while (1) {
84 if (getc() == '\r')
85 break;
86 }
87
88 return 0;
89 case env_op_delete:
90 printf("## Baudrate may not be deleted\n");
91 return 1;
92 default:
93 return 0;
94 }
Marek Vasutf6af0482012-09-12 17:49:58 +020095}
Joe Hershberger3928bb62012-12-11 22:16:27 -060096U_BOOT_ENV_CALLBACK(baudrate, on_baudrate);
Marek Vasutf6af0482012-09-12 17:49:58 +020097
Marek Vasut95656ea2012-10-08 11:36:39 +000098/**
99 * serial_initfunc() - Forward declare of driver registration routine
100 * @name: Name of the real driver registration routine.
101 *
102 * This macro expands onto forward declaration of a driver registration
103 * routine, which is then used below in serial_initialize() function.
104 * The declaration is made weak and aliases to serial_null() so in case
105 * the driver is not compiled in, the function is still declared and can
106 * be used, but aliases to serial_null() and thus is optimized away.
107 */
Marek Vasutf6af0482012-09-12 17:49:58 +0200108#define serial_initfunc(name) \
109 void name(void) \
110 __attribute__((weak, alias("serial_null")));
111
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100112serial_initfunc(atmel_serial_initialize);
113serial_initfunc(au1x00_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100114serial_initfunc(mcf_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100115serial_initfunc(mpc85xx_serial_initialize);
116serial_initfunc(mpc8xx_serial_initialize);
Marek Vasut64c60552012-09-14 22:37:43 +0200117serial_initfunc(mxc_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100118serial_initfunc(ns16550_serial_initialize);
Marek Vasut46e4d5f2012-09-14 22:38:46 +0200119serial_initfunc(pl01x_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100120serial_initfunc(pxa_serial_initialize);
Marek Vasut904d3d72012-09-14 22:40:08 +0200121serial_initfunc(sh_serial_initialize);
Marek Vasut419d8942012-09-12 13:50:56 +0200122
Marek Vasut95656ea2012-10-08 11:36:39 +0000123/**
124 * serial_register() - Register serial driver with serial driver core
125 * @dev: Pointer to the serial driver structure
126 *
127 * This function registers the serial driver supplied via @dev with
128 * serial driver core, thus making U-Boot aware of it and making it
129 * available for U-Boot to use. On platforms that still require manual
130 * relocation of constant variables, relocation of the supplied structure
131 * is performed.
132 */
Mike Frysingerffadc822011-04-29 18:03:30 +0000133void serial_register(struct serial_device *dev)
wdenk7ac16102004-08-01 22:48:16 +0000134{
Wolfgang Denkd0813e52010-10-28 20:00:11 +0200135#ifdef CONFIG_NEEDS_MANUAL_RELOC
Marek Vasut2206b342012-09-16 18:54:22 +0200136 if (dev->start)
137 dev->start += gd->reloc_off;
138 if (dev->stop)
139 dev->stop += gd->reloc_off;
140 if (dev->setbrg)
141 dev->setbrg += gd->reloc_off;
142 if (dev->getc)
143 dev->getc += gd->reloc_off;
144 if (dev->tstc)
145 dev->tstc += gd->reloc_off;
146 if (dev->putc)
147 dev->putc += gd->reloc_off;
148 if (dev->puts)
149 dev->puts += gd->reloc_off;
Peter Tyser9057cbf2009-09-21 11:20:36 -0500150#endif
wdenk7ac16102004-08-01 22:48:16 +0000151
152 dev->next = serial_devices;
153 serial_devices = dev;
wdenk7ac16102004-08-01 22:48:16 +0000154}
155
Marek Vasut95656ea2012-10-08 11:36:39 +0000156/**
157 * serial_initialize() - Register all compiled-in serial port drivers
158 *
159 * This function registers all serial port drivers that are compiled
160 * into the U-Boot binary with the serial core, thus making them
161 * available to U-Boot to use. Lastly, this function assigns a default
162 * serial port to the serial core. That serial port is then used as a
163 * default output.
164 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000165void serial_initialize(void)
wdenk7ac16102004-08-01 22:48:16 +0000166{
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100167 atmel_serial_initialize();
168 au1x00_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100169 mcf_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100170 mpc85xx_serial_initialize();
171 mpc8xx_serial_initialize();
Marek Vasut64c60552012-09-14 22:37:43 +0200172 mxc_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100173 ns16550_serial_initialize();
Marek Vasut46e4d5f2012-09-14 22:38:46 +0200174 pl01x_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100175 pxa_serial_initialize();
Marek Vasut904d3d72012-09-14 22:40:08 +0200176 sh_serial_initialize();
Marek Vasut01f9ea82012-09-13 01:16:50 +0200177
Gerlando Falauto34148d62011-11-18 06:49:11 +0000178 serial_assign(default_serial_console()->name);
wdenk7ac16102004-08-01 22:48:16 +0000179}
180
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200181static int serial_stub_start(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600182{
183 struct serial_device *dev = sdev->priv;
184
185 return dev->start();
186}
187
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200188static int serial_stub_stop(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600189{
190 struct serial_device *dev = sdev->priv;
191
192 return dev->stop();
193}
194
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200195static void serial_stub_putc(struct stdio_dev *sdev, const char ch)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600196{
197 struct serial_device *dev = sdev->priv;
198
199 dev->putc(ch);
200}
201
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200202static void serial_stub_puts(struct stdio_dev *sdev, const char *str)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600203{
204 struct serial_device *dev = sdev->priv;
205
206 dev->puts(str);
207}
208
Masahiro Yamada5e0ef842017-06-22 16:48:49 +0900209static int serial_stub_getc(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600210{
211 struct serial_device *dev = sdev->priv;
212
213 return dev->getc();
214}
215
Masahiro Yamada5e0ef842017-06-22 16:48:49 +0900216static int serial_stub_tstc(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600217{
218 struct serial_device *dev = sdev->priv;
219
220 return dev->tstc();
221}
222
Marek Vasut95656ea2012-10-08 11:36:39 +0000223/**
224 * serial_stdio_init() - Register serial ports with STDIO core
225 *
226 * This function generates a proxy driver for each serial port driver.
227 * These proxy drivers then register with the STDIO core, making the
228 * serial drivers available as STDIO devices.
229 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000230void serial_stdio_init(void)
wdenk7ac16102004-08-01 22:48:16 +0000231{
Jean-Christophe PLAGNIOL-VILLARD2a7a0312009-05-16 12:14:54 +0200232 struct stdio_dev dev;
wdenk7ac16102004-08-01 22:48:16 +0000233 struct serial_device *s = serial_devices;
234
wdenk8f08c5b2004-10-11 22:43:02 +0000235 while (s) {
Gerlando Falauto34148d62011-11-18 06:49:11 +0000236 memset(&dev, 0, sizeof(dev));
wdenk7ac16102004-08-01 22:48:16 +0000237
Gerlando Falauto34148d62011-11-18 06:49:11 +0000238 strcpy(dev.name, s->name);
wdenk7ac16102004-08-01 22:48:16 +0000239 dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
240
Simon Glass0d1e1f72014-07-23 06:54:59 -0600241 dev.start = serial_stub_start;
242 dev.stop = serial_stub_stop;
243 dev.putc = serial_stub_putc;
244 dev.puts = serial_stub_puts;
245 dev.getc = serial_stub_getc;
246 dev.tstc = serial_stub_tstc;
Simon Glassac2a14f2014-09-04 16:27:23 -0600247 dev.priv = s;
wdenk7ac16102004-08-01 22:48:16 +0000248
Gerlando Falauto34148d62011-11-18 06:49:11 +0000249 stdio_register(&dev);
wdenk7ac16102004-08-01 22:48:16 +0000250
251 s = s->next;
252 }
253}
254
Marek Vasut95656ea2012-10-08 11:36:39 +0000255/**
256 * serial_assign() - Select the serial output device by name
257 * @name: Name of the serial driver to be used as default output
258 *
259 * This function configures the serial output multiplexing by
260 * selecting which serial device will be used as default. In case
261 * the STDIO "serial" device is selected as stdin/stdout/stderr,
262 * the serial device previously configured by this function will be
263 * used for the particular operation.
264 *
265 * Returns 0 on success, negative on error.
266 */
Gerlando Falauto92999582011-11-18 06:49:12 +0000267int serial_assign(const char *name)
wdenk7ac16102004-08-01 22:48:16 +0000268{
269 struct serial_device *s;
270
wdenk8f08c5b2004-10-11 22:43:02 +0000271 for (s = serial_devices; s; s = s->next) {
Marek Vasut0e1b5772012-10-06 14:07:03 +0000272 if (strcmp(s->name, name))
273 continue;
274 serial_current = s;
275 return 0;
wdenk7ac16102004-08-01 22:48:16 +0000276 }
277
Marek Vasut0e1b5772012-10-06 14:07:03 +0000278 return -EINVAL;
wdenk7ac16102004-08-01 22:48:16 +0000279}
280
Marek Vasut95656ea2012-10-08 11:36:39 +0000281/**
282 * serial_reinit_all() - Reinitialize all compiled-in serial ports
283 *
284 * This function reinitializes all serial ports that are compiled
285 * into U-Boot by calling their serial_start() functions.
286 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000287void serial_reinit_all(void)
wdenk7ac16102004-08-01 22:48:16 +0000288{
289 struct serial_device *s;
290
Gerlando Falauto34148d62011-11-18 06:49:11 +0000291 for (s = serial_devices; s; s = s->next)
Marek Vasutb46931d2012-09-07 14:35:31 +0200292 s->start();
wdenk7ac16102004-08-01 22:48:16 +0000293}
294
Marek Vasut95656ea2012-10-08 11:36:39 +0000295/**
296 * get_current() - Return pointer to currently selected serial port
297 *
298 * This function returns a pointer to currently selected serial port.
299 * The currently selected serial port is altered by serial_assign()
300 * function.
301 *
302 * In case this function is called before relocation or before any serial
303 * port is configured, this function calls default_serial_console() to
304 * determine the serial port. Otherwise, the configured serial port is
305 * returned.
306 *
307 * Returns pointer to the currently selected serial port on success,
308 * NULL on error.
309 */
Simon Glass8f4e6f12011-08-19 11:09:43 +0000310static struct serial_device *get_current(void)
wdenk7ac16102004-08-01 22:48:16 +0000311{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000312 struct serial_device *dev;
313
Marek Vasutbdad8072012-10-06 14:07:04 +0000314 if (!(gd->flags & GD_FLG_RELOC))
Simon Glass8f4e6f12011-08-19 11:09:43 +0000315 dev = default_serial_console();
Marek Vasutbdad8072012-10-06 14:07:04 +0000316 else if (!serial_current)
317 dev = default_serial_console();
318 else
319 dev = serial_current;
wdenk8f08c5b2004-10-11 22:43:02 +0000320
Marek Vasutbdad8072012-10-06 14:07:04 +0000321 /* We must have a console device */
322 if (!dev) {
Marek Vasuta6f63342012-09-15 10:33:51 +0200323#ifdef CONFIG_SPL_BUILD
Marek Vasutbdad8072012-10-06 14:07:04 +0000324 puts("Cannot find console\n");
325 hang();
Marek Vasuta6f63342012-09-15 10:33:51 +0200326#else
Marek Vasutbdad8072012-10-06 14:07:04 +0000327 panic("Cannot find console\n");
Marek Vasuta6f63342012-09-15 10:33:51 +0200328#endif
Marek Vasutbdad8072012-10-06 14:07:04 +0000329 }
330
Simon Glass8f4e6f12011-08-19 11:09:43 +0000331 return dev;
332}
wdenk7ac16102004-08-01 22:48:16 +0000333
Marek Vasut95656ea2012-10-08 11:36:39 +0000334/**
335 * serial_init() - Initialize currently selected serial port
336 *
337 * This function initializes the currently selected serial port. This
338 * usually involves setting up the registers of that particular port,
339 * enabling clock and such. This function uses the get_current() call
340 * to determine which port is selected.
341 *
342 * Returns 0 on success, negative on error.
343 */
Simon Glass8f4e6f12011-08-19 11:09:43 +0000344int serial_init(void)
345{
Simon Glassb9d5f6b2014-07-23 06:55:07 -0600346 gd->flags |= GD_FLG_SERIAL_READY;
Marek Vasutb46931d2012-09-07 14:35:31 +0200347 return get_current()->start();
wdenk7ac16102004-08-01 22:48:16 +0000348}
349
Marek Vasut95656ea2012-10-08 11:36:39 +0000350/**
351 * serial_setbrg() - Configure baud-rate of currently selected serial port
352 *
353 * This function configures the baud-rate of the currently selected
354 * serial port. The baud-rate is retrieved from global data within
355 * the serial port driver. This function uses the get_current() call
356 * to determine which port is selected.
357 *
358 * Returns 0 on success, negative on error.
359 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000360void serial_setbrg(void)
wdenk7ac16102004-08-01 22:48:16 +0000361{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000362 get_current()->setbrg();
wdenk7ac16102004-08-01 22:48:16 +0000363}
364
Marek Vasut95656ea2012-10-08 11:36:39 +0000365/**
366 * serial_getc() - Read character from currently selected serial port
367 *
368 * This function retrieves a character from currently selected serial
369 * port. In case there is no character waiting on the serial port,
370 * this function will block and wait for the character to appear. This
371 * function uses the get_current() call to determine which port is
372 * selected.
373 *
374 * Returns the character on success, negative on error.
375 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000376int serial_getc(void)
wdenk7ac16102004-08-01 22:48:16 +0000377{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000378 return get_current()->getc();
wdenk7ac16102004-08-01 22:48:16 +0000379}
380
Marek Vasut95656ea2012-10-08 11:36:39 +0000381/**
382 * serial_tstc() - Test if data is available on currently selected serial port
383 *
384 * This function tests if one or more characters are available on
385 * currently selected serial port. This function never blocks. This
386 * function uses the get_current() call to determine which port is
387 * selected.
388 *
389 * Returns positive if character is available, zero otherwise.
390 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000391int serial_tstc(void)
wdenk7ac16102004-08-01 22:48:16 +0000392{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000393 return get_current()->tstc();
wdenk7ac16102004-08-01 22:48:16 +0000394}
395
Marek Vasut95656ea2012-10-08 11:36:39 +0000396/**
397 * serial_putc() - Output character via currently selected serial port
398 * @c: Single character to be output from the serial port.
399 *
400 * This function outputs a character via currently selected serial
401 * port. This character is passed to the serial port driver responsible
402 * for controlling the hardware. The hardware may still be in process
403 * of transmitting another character, therefore this function may block
404 * for a short amount of time. This function uses the get_current()
405 * call to determine which port is selected.
406 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000407void serial_putc(const char c)
wdenk7ac16102004-08-01 22:48:16 +0000408{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000409 get_current()->putc(c);
wdenk7ac16102004-08-01 22:48:16 +0000410}
411
Marek Vasut95656ea2012-10-08 11:36:39 +0000412/**
413 * serial_puts() - Output string via currently selected serial port
414 * @s: Zero-terminated string to be output from the serial port.
415 *
416 * This function outputs a zero-terminated string via currently
417 * selected serial port. This function behaves as an accelerator
418 * in case the hardware can queue multiple characters for transfer.
419 * The whole string that is to be output is available to the function
420 * implementing the hardware manipulation. Transmitting the whole
421 * string may take some time, thus this function may block for some
422 * amount of time. This function uses the get_current() call to
423 * determine which port is selected.
424 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000425void serial_puts(const char *s)
wdenk7ac16102004-08-01 22:48:16 +0000426{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000427 get_current()->puts(s);
wdenk7ac16102004-08-01 22:48:16 +0000428}
Mike Frysinger078f2f12011-05-14 06:56:15 +0000429
Marek Vasut95656ea2012-10-08 11:36:39 +0000430/**
431 * default_serial_puts() - Output string by calling serial_putc() in loop
432 * @s: Zero-terminated string to be output from the serial port.
433 *
434 * This function outputs a zero-terminated string by calling serial_putc()
435 * in a loop. Most drivers do not support queueing more than one byte for
436 * transfer, thus this function precisely implements their serial_puts().
437 *
438 * To optimize the number of get_current() calls, this function only
439 * calls get_current() once and then directly accesses the putc() call
440 * of the &struct serial_device .
441 */
Marek Vasut6b9124e2012-10-06 14:07:01 +0000442void default_serial_puts(const char *s)
443{
444 struct serial_device *dev = get_current();
445 while (*s)
446 dev->putc(*s++);
447}
448
Mike Frysinger078f2f12011-05-14 06:56:15 +0000449#if CONFIG_POST & CONFIG_SYS_POST_UART
450static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE;
451
Marek Vasut95656ea2012-10-08 11:36:39 +0000452/**
453 * uart_post_test() - Test the currently selected serial port using POST
454 * @flags: POST framework flags
455 *
456 * Do a loopback test of the currently selected serial port. This
457 * function is only useful in the context of the POST testing framwork.
Vagrant Cascadianbeb288b2015-11-24 14:46:24 -0800458 * The serial port is first configured into loopback mode and then
Marek Vasut95656ea2012-10-08 11:36:39 +0000459 * characters are sent through it.
460 *
461 * Returns 0 on success, value otherwise.
462 */
Mike Frysinger078f2f12011-05-14 06:56:15 +0000463/* Mark weak until post/cpu/.../uart.c migrate over */
464__weak
465int uart_post_test(int flags)
466{
467 unsigned char c;
468 int ret, saved_baud, b;
469 struct serial_device *saved_dev, *s;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000470
471 /* Save current serial state */
472 ret = 0;
473 saved_dev = serial_current;
Masahiro Yamada197c7202014-04-04 20:09:58 +0900474 saved_baud = gd->baudrate;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000475
476 for (s = serial_devices; s; s = s->next) {
477 /* If this driver doesn't support loop back, skip it */
478 if (!s->loop)
479 continue;
480
481 /* Test the next device */
482 serial_current = s;
483
484 ret = serial_init();
485 if (ret)
486 goto done;
487
488 /* Consume anything that happens to be queued */
489 while (serial_tstc())
490 serial_getc();
491
492 /* Enable loop back */
493 s->loop(1);
494
495 /* Test every available baud rate */
496 for (b = 0; b < ARRAY_SIZE(bauds); ++b) {
Masahiro Yamada197c7202014-04-04 20:09:58 +0900497 gd->baudrate = bauds[b];
Mike Frysinger078f2f12011-05-14 06:56:15 +0000498 serial_setbrg();
499
500 /*
501 * Stick to printable chars to avoid issues:
502 * - terminal corruption
503 * - serial program reacting to sequences and sending
504 * back random extra data
505 * - most serial drivers add in extra chars (like \r\n)
506 */
507 for (c = 0x20; c < 0x7f; ++c) {
508 /* Send it out */
509 serial_putc(c);
510
511 /* Make sure it's the same one */
512 ret = (c != serial_getc());
513 if (ret) {
514 s->loop(0);
515 goto done;
516 }
517
518 /* Clean up the output in case it was sent */
519 serial_putc('\b');
520 ret = ('\b' != serial_getc());
521 if (ret) {
522 s->loop(0);
523 goto done;
524 }
525 }
526 }
527
528 /* Disable loop back */
529 s->loop(0);
530
Marek Vasutb46931d2012-09-07 14:35:31 +0200531 /* XXX: There is no serial_stop() !? */
532 if (s->stop)
533 s->stop();
Mike Frysinger078f2f12011-05-14 06:56:15 +0000534 }
535
536 done:
537 /* Restore previous serial state */
538 serial_current = saved_dev;
Masahiro Yamada197c7202014-04-04 20:09:58 +0900539 gd->baudrate = saved_baud;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000540 serial_reinit_all();
541 serial_setbrg();
542
543 return ret;
544}
545#endif