blob: c499601f000fef359f3176cd2dba5d87237c051a [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
wdenk281e00a2004-08-01 22:48:16 +00002/*
3 * (C) Copyright 2004
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
wdenk281e00a2004-08-01 22:48:16 +00005 */
6
7#include <common.h>
Joe Hershberger32057712012-12-11 22:16:27 -06008#include <environment.h>
wdenk281e00a2004-08-01 22:48:16 +00009#include <serial.h>
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020010#include <stdio_dev.h>
Mike Frysinger7b826c22011-05-14 06:56:15 +000011#include <post.h>
12#include <linux/compiler.h>
Marek Vasut6d93e252012-10-06 14:07:03 +000013#include <errno.h>
wdenk281e00a2004-08-01 22:48:16 +000014
Wolfgang Denkd87080b2006-03-31 18:32:53 +020015DECLARE_GLOBAL_DATA_PTR;
16
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +000017static struct serial_device *serial_devices;
18static struct serial_device *serial_current;
Joe Hershberger32057712012-12-11 22:16:27 -060019/*
20 * Table with supported baudrates (defined in config_xyz.h)
21 */
22static const unsigned long baudrate_table[] = CONFIG_SYS_BAUDRATE_TABLE;
wdenk281e00a2004-08-01 22:48:16 +000023
Marek Vasut9cd2b9e2012-10-08 11:36:39 +000024/**
25 * serial_null() - Void registration routine of a serial driver
26 *
27 * This routine implements a void registration routine of a serial
28 * driver. The registration routine of a particular driver is aliased
29 * to this empty function in case the driver is not compiled into
30 * U-Boot.
31 */
Marek Vasut2a333ae2012-09-12 17:49:58 +020032static void serial_null(void)
33{
34}
35
Marek Vasut9cd2b9e2012-10-08 11:36:39 +000036/**
Joe Hershberger32057712012-12-11 22:16:27 -060037 * on_baudrate() - Update the actual baudrate when the env var changes
38 *
Heinrich Schuchardt938b05a2018-07-29 10:41:02 +020039 * @name: changed environment variable
40 * @value: new value of the environment variable
41 * @op: operation (create, overwrite, or delete)
42 * @flags: attributes of environment variable change,
43 * see flags H_* in include/search.h
44 *
Joe Hershberger32057712012-12-11 22:16:27 -060045 * This will check for a valid baudrate and only apply it if valid.
Heinrich Schuchardt938b05a2018-07-29 10:41:02 +020046 *
47 * Return: 0 on success, 1 on error
Joe Hershberger32057712012-12-11 22:16:27 -060048 */
49static int on_baudrate(const char *name, const char *value, enum env_op op,
50 int flags)
51{
52 int i;
53 int baudrate;
54
55 switch (op) {
56 case env_op_create:
57 case env_op_overwrite:
58 /*
59 * Switch to new baudrate if new baudrate is supported
60 */
61 baudrate = simple_strtoul(value, NULL, 10);
62
63 /* Not actually changing */
64 if (gd->baudrate == baudrate)
65 return 0;
66
Axel Lin99351752013-06-23 00:46:41 +080067 for (i = 0; i < ARRAY_SIZE(baudrate_table); ++i) {
Joe Hershberger32057712012-12-11 22:16:27 -060068 if (baudrate == baudrate_table[i])
69 break;
70 }
Axel Lin99351752013-06-23 00:46:41 +080071 if (i == ARRAY_SIZE(baudrate_table)) {
Joe Hershberger32057712012-12-11 22:16:27 -060072 if ((flags & H_FORCE) == 0)
73 printf("## Baudrate %d bps not supported\n",
74 baudrate);
75 return 1;
76 }
77 if ((flags & H_INTERACTIVE) != 0) {
78 printf("## Switch baudrate to %d"
79 " bps and press ENTER ...\n", baudrate);
80 udelay(50000);
81 }
82
83 gd->baudrate = baudrate;
Joe Hershberger32057712012-12-11 22:16:27 -060084
85 serial_setbrg();
86
87 udelay(50000);
88
89 if ((flags & H_INTERACTIVE) != 0)
90 while (1) {
91 if (getc() == '\r')
92 break;
93 }
94
95 return 0;
96 case env_op_delete:
97 printf("## Baudrate may not be deleted\n");
98 return 1;
99 default:
100 return 0;
101 }
102}
103U_BOOT_ENV_CALLBACK(baudrate, on_baudrate);
104
105/**
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000106 * serial_initfunc() - Forward declare of driver registration routine
107 * @name: Name of the real driver registration routine.
108 *
109 * This macro expands onto forward declaration of a driver registration
110 * routine, which is then used below in serial_initialize() function.
111 * The declaration is made weak and aliases to serial_null() so in case
112 * the driver is not compiled in, the function is still declared and can
113 * be used, but aliases to serial_null() and thus is optimized away.
114 */
Marek Vasut2a333ae2012-09-12 17:49:58 +0200115#define serial_initfunc(name) \
116 void name(void) \
117 __attribute__((weak, alias("serial_null")));
118
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100119serial_initfunc(atmel_serial_initialize);
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100120serial_initfunc(mcf_serial_initialize);
Marek Vasut7a311542012-09-13 01:38:52 +0200121serial_initfunc(mpc85xx_serial_initialize);
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100122serial_initfunc(mpc8xx_serial_initialize);
Marek Vasuta9434722012-09-14 22:37:43 +0200123serial_initfunc(mxc_serial_initialize);
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100124serial_initfunc(ns16550_serial_initialize);
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100125serial_initfunc(pl01x_serial_initialize);
126serial_initfunc(pxa_serial_initialize);
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100127serial_initfunc(sh_serial_initialize);
Marek Vasutf0eb1f62012-09-12 13:50:56 +0200128
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000129/**
130 * serial_register() - Register serial driver with serial driver core
131 * @dev: Pointer to the serial driver structure
132 *
133 * This function registers the serial driver supplied via @dev with
134 * serial driver core, thus making U-Boot aware of it and making it
135 * available for U-Boot to use. On platforms that still require manual
136 * relocation of constant variables, relocation of the supplied structure
137 * is performed.
138 */
Mike Frysingerc52b4f72011-04-29 18:03:30 +0000139void serial_register(struct serial_device *dev)
wdenk281e00a2004-08-01 22:48:16 +0000140{
Wolfgang Denk2e5167c2010-10-28 20:00:11 +0200141#ifdef CONFIG_NEEDS_MANUAL_RELOC
Marek Vasutf2760c42012-09-16 18:54:22 +0200142 if (dev->start)
143 dev->start += gd->reloc_off;
144 if (dev->stop)
145 dev->stop += gd->reloc_off;
146 if (dev->setbrg)
147 dev->setbrg += gd->reloc_off;
148 if (dev->getc)
149 dev->getc += gd->reloc_off;
150 if (dev->tstc)
151 dev->tstc += gd->reloc_off;
152 if (dev->putc)
153 dev->putc += gd->reloc_off;
154 if (dev->puts)
155 dev->puts += gd->reloc_off;
Peter Tyser521af042009-09-21 11:20:36 -0500156#endif
wdenk281e00a2004-08-01 22:48:16 +0000157
158 dev->next = serial_devices;
159 serial_devices = dev;
wdenk281e00a2004-08-01 22:48:16 +0000160}
161
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000162/**
163 * serial_initialize() - Register all compiled-in serial port drivers
164 *
165 * This function registers all serial port drivers that are compiled
166 * into the U-Boot binary with the serial core, thus making them
167 * available to U-Boot to use. Lastly, this function assigns a default
168 * serial port to the serial core. That serial port is then used as a
169 * default output.
170 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000171void serial_initialize(void)
wdenk281e00a2004-08-01 22:48:16 +0000172{
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100173 atmel_serial_initialize();
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100174 mcf_serial_initialize();
Marek Vasut7a311542012-09-13 01:38:52 +0200175 mpc85xx_serial_initialize();
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100176 mpc8xx_serial_initialize();
Marek Vasuta9434722012-09-14 22:37:43 +0200177 mxc_serial_initialize();
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100178 ns16550_serial_initialize();
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100179 pl01x_serial_initialize();
180 pxa_serial_initialize();
Jeroen Hofstee94a255d2014-10-27 20:10:07 +0100181 sh_serial_initialize();
Marek Vasut7b953c52012-09-13 01:16:50 +0200182
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000183 serial_assign(default_serial_console()->name);
wdenk281e00a2004-08-01 22:48:16 +0000184}
185
Jeroen Hofstee654f8d02014-10-08 22:57:44 +0200186static int serial_stub_start(struct stdio_dev *sdev)
Simon Glass709ea542014-07-23 06:54:59 -0600187{
188 struct serial_device *dev = sdev->priv;
189
190 return dev->start();
191}
192
Jeroen Hofstee654f8d02014-10-08 22:57:44 +0200193static int serial_stub_stop(struct stdio_dev *sdev)
Simon Glass709ea542014-07-23 06:54:59 -0600194{
195 struct serial_device *dev = sdev->priv;
196
197 return dev->stop();
198}
199
Jeroen Hofstee654f8d02014-10-08 22:57:44 +0200200static void serial_stub_putc(struct stdio_dev *sdev, const char ch)
Simon Glass709ea542014-07-23 06:54:59 -0600201{
202 struct serial_device *dev = sdev->priv;
203
204 dev->putc(ch);
205}
206
Jeroen Hofstee654f8d02014-10-08 22:57:44 +0200207static void serial_stub_puts(struct stdio_dev *sdev, const char *str)
Simon Glass709ea542014-07-23 06:54:59 -0600208{
209 struct serial_device *dev = sdev->priv;
210
211 dev->puts(str);
212}
213
Masahiro Yamada49ddcf32017-06-22 16:48:49 +0900214static int serial_stub_getc(struct stdio_dev *sdev)
Simon Glass709ea542014-07-23 06:54:59 -0600215{
216 struct serial_device *dev = sdev->priv;
217
218 return dev->getc();
219}
220
Masahiro Yamada49ddcf32017-06-22 16:48:49 +0900221static int serial_stub_tstc(struct stdio_dev *sdev)
Simon Glass709ea542014-07-23 06:54:59 -0600222{
223 struct serial_device *dev = sdev->priv;
224
225 return dev->tstc();
226}
227
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000228/**
229 * serial_stdio_init() - Register serial ports with STDIO core
230 *
231 * This function generates a proxy driver for each serial port driver.
232 * These proxy drivers then register with the STDIO core, making the
233 * serial drivers available as STDIO devices.
234 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000235void serial_stdio_init(void)
wdenk281e00a2004-08-01 22:48:16 +0000236{
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200237 struct stdio_dev dev;
wdenk281e00a2004-08-01 22:48:16 +0000238 struct serial_device *s = serial_devices;
239
wdenk2ee66532004-10-11 22:43:02 +0000240 while (s) {
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000241 memset(&dev, 0, sizeof(dev));
wdenk281e00a2004-08-01 22:48:16 +0000242
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000243 strcpy(dev.name, s->name);
wdenk281e00a2004-08-01 22:48:16 +0000244 dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
245
Simon Glass709ea542014-07-23 06:54:59 -0600246 dev.start = serial_stub_start;
247 dev.stop = serial_stub_stop;
248 dev.putc = serial_stub_putc;
249 dev.puts = serial_stub_puts;
250 dev.getc = serial_stub_getc;
251 dev.tstc = serial_stub_tstc;
Simon Glassaddf9512014-09-04 16:27:23 -0600252 dev.priv = s;
wdenk281e00a2004-08-01 22:48:16 +0000253
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000254 stdio_register(&dev);
wdenk281e00a2004-08-01 22:48:16 +0000255
256 s = s->next;
257 }
258}
259
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000260/**
261 * serial_assign() - Select the serial output device by name
262 * @name: Name of the serial driver to be used as default output
263 *
264 * This function configures the serial output multiplexing by
265 * selecting which serial device will be used as default. In case
266 * the STDIO "serial" device is selected as stdin/stdout/stderr,
267 * the serial device previously configured by this function will be
268 * used for the particular operation.
269 *
270 * Returns 0 on success, negative on error.
271 */
Gerlando Falauto7813ca92011-11-18 06:49:12 +0000272int serial_assign(const char *name)
wdenk281e00a2004-08-01 22:48:16 +0000273{
274 struct serial_device *s;
275
wdenk2ee66532004-10-11 22:43:02 +0000276 for (s = serial_devices; s; s = s->next) {
Marek Vasut6d93e252012-10-06 14:07:03 +0000277 if (strcmp(s->name, name))
278 continue;
279 serial_current = s;
280 return 0;
wdenk281e00a2004-08-01 22:48:16 +0000281 }
282
Marek Vasut6d93e252012-10-06 14:07:03 +0000283 return -EINVAL;
wdenk281e00a2004-08-01 22:48:16 +0000284}
285
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000286/**
287 * serial_reinit_all() - Reinitialize all compiled-in serial ports
288 *
289 * This function reinitializes all serial ports that are compiled
290 * into U-Boot by calling their serial_start() functions.
291 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000292void serial_reinit_all(void)
wdenk281e00a2004-08-01 22:48:16 +0000293{
294 struct serial_device *s;
295
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000296 for (s = serial_devices; s; s = s->next)
Marek Vasut89143fb2012-09-07 14:35:31 +0200297 s->start();
wdenk281e00a2004-08-01 22:48:16 +0000298}
299
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000300/**
301 * get_current() - Return pointer to currently selected serial port
302 *
303 * This function returns a pointer to currently selected serial port.
304 * The currently selected serial port is altered by serial_assign()
305 * function.
306 *
307 * In case this function is called before relocation or before any serial
308 * port is configured, this function calls default_serial_console() to
309 * determine the serial port. Otherwise, the configured serial port is
310 * returned.
311 *
312 * Returns pointer to the currently selected serial port on success,
313 * NULL on error.
314 */
Simon Glass857c2832011-08-19 11:09:43 +0000315static struct serial_device *get_current(void)
wdenk281e00a2004-08-01 22:48:16 +0000316{
Simon Glass857c2832011-08-19 11:09:43 +0000317 struct serial_device *dev;
318
Marek Vasutdee19412012-10-06 14:07:04 +0000319 if (!(gd->flags & GD_FLG_RELOC))
Simon Glass857c2832011-08-19 11:09:43 +0000320 dev = default_serial_console();
Marek Vasutdee19412012-10-06 14:07:04 +0000321 else if (!serial_current)
322 dev = default_serial_console();
323 else
Simon Glass857c2832011-08-19 11:09:43 +0000324 dev = serial_current;
Marek Vasutdee19412012-10-06 14:07:04 +0000325
326 /* We must have a console device */
327 if (!dev) {
328#ifdef CONFIG_SPL_BUILD
329 puts("Cannot find console\n");
330 hang();
331#else
332 panic("Cannot find console\n");
333#endif
334 }
335
Simon Glass857c2832011-08-19 11:09:43 +0000336 return dev;
337}
wdenk281e00a2004-08-01 22:48:16 +0000338
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000339/**
340 * serial_init() - Initialize currently selected serial port
341 *
342 * This function initializes the currently selected serial port. This
343 * usually involves setting up the registers of that particular port,
344 * enabling clock and such. This function uses the get_current() call
345 * to determine which port is selected.
346 *
347 * Returns 0 on success, negative on error.
348 */
Simon Glass857c2832011-08-19 11:09:43 +0000349int serial_init(void)
350{
Simon Glass093f79a2014-07-23 06:55:07 -0600351 gd->flags |= GD_FLG_SERIAL_READY;
Marek Vasut89143fb2012-09-07 14:35:31 +0200352 return get_current()->start();
wdenk281e00a2004-08-01 22:48:16 +0000353}
354
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000355/**
356 * serial_setbrg() - Configure baud-rate of currently selected serial port
357 *
358 * This function configures the baud-rate of the currently selected
359 * serial port. The baud-rate is retrieved from global data within
360 * the serial port driver. This function uses the get_current() call
361 * to determine which port is selected.
362 *
363 * Returns 0 on success, negative on error.
364 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000365void serial_setbrg(void)
wdenk281e00a2004-08-01 22:48:16 +0000366{
Simon Glass857c2832011-08-19 11:09:43 +0000367 get_current()->setbrg();
wdenk281e00a2004-08-01 22:48:16 +0000368}
369
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000370/**
371 * serial_getc() - Read character from currently selected serial port
372 *
373 * This function retrieves a character from currently selected serial
374 * port. In case there is no character waiting on the serial port,
375 * this function will block and wait for the character to appear. This
376 * function uses the get_current() call to determine which port is
377 * selected.
378 *
379 * Returns the character on success, negative on error.
380 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000381int serial_getc(void)
wdenk281e00a2004-08-01 22:48:16 +0000382{
Simon Glass857c2832011-08-19 11:09:43 +0000383 return get_current()->getc();
wdenk281e00a2004-08-01 22:48:16 +0000384}
385
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000386/**
387 * serial_tstc() - Test if data is available on currently selected serial port
388 *
389 * This function tests if one or more characters are available on
390 * currently selected serial port. This function never blocks. This
391 * function uses the get_current() call to determine which port is
392 * selected.
393 *
394 * Returns positive if character is available, zero otherwise.
395 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000396int serial_tstc(void)
wdenk281e00a2004-08-01 22:48:16 +0000397{
Simon Glass857c2832011-08-19 11:09:43 +0000398 return get_current()->tstc();
wdenk281e00a2004-08-01 22:48:16 +0000399}
400
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000401/**
402 * serial_putc() - Output character via currently selected serial port
403 * @c: Single character to be output from the serial port.
404 *
405 * This function outputs a character via currently selected serial
406 * port. This character is passed to the serial port driver responsible
407 * for controlling the hardware. The hardware may still be in process
408 * of transmitting another character, therefore this function may block
409 * for a short amount of time. This function uses the get_current()
410 * call to determine which port is selected.
411 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000412void serial_putc(const char c)
wdenk281e00a2004-08-01 22:48:16 +0000413{
Simon Glass857c2832011-08-19 11:09:43 +0000414 get_current()->putc(c);
wdenk281e00a2004-08-01 22:48:16 +0000415}
416
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000417/**
418 * serial_puts() - Output string via currently selected serial port
419 * @s: Zero-terminated string to be output from the serial port.
420 *
421 * This function outputs a zero-terminated string via currently
422 * selected serial port. This function behaves as an accelerator
423 * in case the hardware can queue multiple characters for transfer.
424 * The whole string that is to be output is available to the function
425 * implementing the hardware manipulation. Transmitting the whole
426 * string may take some time, thus this function may block for some
427 * amount of time. This function uses the get_current() call to
428 * determine which port is selected.
429 */
Gerlando Falautoa6e6f7f2011-11-18 06:49:11 +0000430void serial_puts(const char *s)
wdenk281e00a2004-08-01 22:48:16 +0000431{
Simon Glass857c2832011-08-19 11:09:43 +0000432 get_current()->puts(s);
wdenk281e00a2004-08-01 22:48:16 +0000433}
Mike Frysinger7b826c22011-05-14 06:56:15 +0000434
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000435/**
436 * default_serial_puts() - Output string by calling serial_putc() in loop
437 * @s: Zero-terminated string to be output from the serial port.
438 *
439 * This function outputs a zero-terminated string by calling serial_putc()
440 * in a loop. Most drivers do not support queueing more than one byte for
441 * transfer, thus this function precisely implements their serial_puts().
442 *
443 * To optimize the number of get_current() calls, this function only
444 * calls get_current() once and then directly accesses the putc() call
445 * of the &struct serial_device .
446 */
Marek Vasutbfb7d7a2012-10-06 14:07:01 +0000447void default_serial_puts(const char *s)
448{
449 struct serial_device *dev = get_current();
450 while (*s)
451 dev->putc(*s++);
452}
453
Mike Frysinger7b826c22011-05-14 06:56:15 +0000454#if CONFIG_POST & CONFIG_SYS_POST_UART
455static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE;
456
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000457/**
458 * uart_post_test() - Test the currently selected serial port using POST
459 * @flags: POST framework flags
460 *
461 * Do a loopback test of the currently selected serial port. This
462 * function is only useful in the context of the POST testing framwork.
Vagrant Cascadian1b25e582015-11-24 14:46:24 -0800463 * The serial port is first configured into loopback mode and then
Marek Vasut9cd2b9e2012-10-08 11:36:39 +0000464 * characters are sent through it.
465 *
466 * Returns 0 on success, value otherwise.
467 */
Mike Frysinger7b826c22011-05-14 06:56:15 +0000468/* Mark weak until post/cpu/.../uart.c migrate over */
469__weak
470int uart_post_test(int flags)
471{
472 unsigned char c;
473 int ret, saved_baud, b;
474 struct serial_device *saved_dev, *s;
Mike Frysinger7b826c22011-05-14 06:56:15 +0000475
476 /* Save current serial state */
477 ret = 0;
478 saved_dev = serial_current;
Masahiro Yamada8e261572014-04-04 20:09:58 +0900479 saved_baud = gd->baudrate;
Mike Frysinger7b826c22011-05-14 06:56:15 +0000480
481 for (s = serial_devices; s; s = s->next) {
482 /* If this driver doesn't support loop back, skip it */
483 if (!s->loop)
484 continue;
485
486 /* Test the next device */
487 serial_current = s;
488
489 ret = serial_init();
490 if (ret)
491 goto done;
492
493 /* Consume anything that happens to be queued */
494 while (serial_tstc())
495 serial_getc();
496
497 /* Enable loop back */
498 s->loop(1);
499
500 /* Test every available baud rate */
501 for (b = 0; b < ARRAY_SIZE(bauds); ++b) {
Masahiro Yamada8e261572014-04-04 20:09:58 +0900502 gd->baudrate = bauds[b];
Mike Frysinger7b826c22011-05-14 06:56:15 +0000503 serial_setbrg();
504
505 /*
506 * Stick to printable chars to avoid issues:
507 * - terminal corruption
508 * - serial program reacting to sequences and sending
509 * back random extra data
510 * - most serial drivers add in extra chars (like \r\n)
511 */
512 for (c = 0x20; c < 0x7f; ++c) {
513 /* Send it out */
514 serial_putc(c);
515
516 /* Make sure it's the same one */
517 ret = (c != serial_getc());
518 if (ret) {
519 s->loop(0);
520 goto done;
521 }
522
523 /* Clean up the output in case it was sent */
524 serial_putc('\b');
525 ret = ('\b' != serial_getc());
526 if (ret) {
527 s->loop(0);
528 goto done;
529 }
530 }
531 }
532
533 /* Disable loop back */
534 s->loop(0);
535
Marek Vasut89143fb2012-09-07 14:35:31 +0200536 /* XXX: There is no serial_stop() !? */
537 if (s->stop)
538 s->stop();
Mike Frysinger7b826c22011-05-14 06:56:15 +0000539 }
540
541 done:
542 /* Restore previous serial state */
543 serial_current = saved_dev;
Masahiro Yamada8e261572014-04-04 20:09:58 +0900544 gd->baudrate = saved_baud;
Mike Frysinger7b826c22011-05-14 06:56:15 +0000545 serial_reinit_all();
546 serial_setbrg();
547
548 return ret;
549}
550#endif