blob: 53358acb81f2087589aae813d3559ac149acc769 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
wdenk7ac16102004-08-01 22:48:16 +00002/*
3 * (C) Copyright 2004
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
wdenk7ac16102004-08-01 22:48:16 +00005 */
6
7#include <common.h>
Simon Glass9d1f6192019-08-02 09:44:25 -06008#include <env_internal.h>
Simon Glassf11478f2019-12-28 10:45:07 -07009#include <hang.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>
Simon Glassdbd79542020-05-10 11:40:11 -060015#include <linux/delay.h>
wdenk7ac16102004-08-01 22:48:16 +000016
Wolfgang Denk6405a152006-03-31 18:32:53 +020017DECLARE_GLOBAL_DATA_PTR;
18
Gerlando Falauto34148d62011-11-18 06:49:11 +000019static struct serial_device *serial_devices;
20static struct serial_device *serial_current;
Joe Hershberger3928bb62012-12-11 22:16:27 -060021/*
22 * Table with supported baudrates (defined in config_xyz.h)
23 */
24static const unsigned long baudrate_table[] = CONFIG_SYS_BAUDRATE_TABLE;
wdenk7ac16102004-08-01 22:48:16 +000025
Marek Vasut95656ea2012-10-08 11:36:39 +000026/**
27 * serial_null() - Void registration routine of a serial driver
28 *
29 * This routine implements a void registration routine of a serial
30 * driver. The registration routine of a particular driver is aliased
31 * to this empty function in case the driver is not compiled into
32 * U-Boot.
33 */
Marek Vasutf6af0482012-09-12 17:49:58 +020034static void serial_null(void)
35{
Joe Hershberger3928bb62012-12-11 22:16:27 -060036}
37
38/**
39 * on_baudrate() - Update the actual baudrate when the env var changes
40 *
Heinrich Schuchardt995ea732018-07-29 10:41:02 +020041 * @name: changed environment variable
42 * @value: new value of the environment variable
43 * @op: operation (create, overwrite, or delete)
44 * @flags: attributes of environment variable change,
45 * see flags H_* in include/search.h
46 *
Joe Hershberger3928bb62012-12-11 22:16:27 -060047 * This will check for a valid baudrate and only apply it if valid.
Heinrich Schuchardt995ea732018-07-29 10:41:02 +020048 *
49 * Return: 0 on success, 1 on error
Joe Hershberger3928bb62012-12-11 22:16:27 -060050 */
51static int on_baudrate(const char *name, const char *value, enum env_op op,
52 int flags)
53{
54 int i;
55 int baudrate;
56
57 switch (op) {
58 case env_op_create:
59 case env_op_overwrite:
60 /*
61 * Switch to new baudrate if new baudrate is supported
62 */
63 baudrate = simple_strtoul(value, NULL, 10);
64
65 /* Not actually changing */
66 if (gd->baudrate == baudrate)
67 return 0;
68
Axel Linebca8732013-06-23 00:46:41 +080069 for (i = 0; i < ARRAY_SIZE(baudrate_table); ++i) {
Joe Hershberger3928bb62012-12-11 22:16:27 -060070 if (baudrate == baudrate_table[i])
71 break;
72 }
Axel Linebca8732013-06-23 00:46:41 +080073 if (i == ARRAY_SIZE(baudrate_table)) {
Joe Hershberger3928bb62012-12-11 22:16:27 -060074 if ((flags & H_FORCE) == 0)
75 printf("## Baudrate %d bps not supported\n",
76 baudrate);
77 return 1;
78 }
79 if ((flags & H_INTERACTIVE) != 0) {
80 printf("## Switch baudrate to %d"
81 " bps and press ENTER ...\n", baudrate);
82 udelay(50000);
83 }
84
85 gd->baudrate = baudrate;
Joe Hershberger3928bb62012-12-11 22:16:27 -060086
87 serial_setbrg();
88
89 udelay(50000);
90
91 if ((flags & H_INTERACTIVE) != 0)
92 while (1) {
93 if (getc() == '\r')
94 break;
95 }
96
97 return 0;
98 case env_op_delete:
99 printf("## Baudrate may not be deleted\n");
100 return 1;
101 default:
102 return 0;
103 }
Marek Vasutf6af0482012-09-12 17:49:58 +0200104}
Joe Hershberger3928bb62012-12-11 22:16:27 -0600105U_BOOT_ENV_CALLBACK(baudrate, on_baudrate);
Marek Vasutf6af0482012-09-12 17:49:58 +0200106
Marek Vasut95656ea2012-10-08 11:36:39 +0000107/**
108 * serial_initfunc() - Forward declare of driver registration routine
109 * @name: Name of the real driver registration routine.
110 *
111 * This macro expands onto forward declaration of a driver registration
112 * routine, which is then used below in serial_initialize() function.
113 * The declaration is made weak and aliases to serial_null() so in case
114 * the driver is not compiled in, the function is still declared and can
115 * be used, but aliases to serial_null() and thus is optimized away.
116 */
Marek Vasutf6af0482012-09-12 17:49:58 +0200117#define serial_initfunc(name) \
118 void name(void) \
119 __attribute__((weak, alias("serial_null")));
120
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100121serial_initfunc(atmel_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100122serial_initfunc(mcf_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100123serial_initfunc(mpc85xx_serial_initialize);
Marek Vasut64c60552012-09-14 22:37:43 +0200124serial_initfunc(mxc_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100125serial_initfunc(ns16550_serial_initialize);
Marek Vasut46e4d5f2012-09-14 22:38:46 +0200126serial_initfunc(pl01x_serial_initialize);
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100127serial_initfunc(pxa_serial_initialize);
Marek Vasut904d3d72012-09-14 22:40:08 +0200128serial_initfunc(sh_serial_initialize);
developer77c7c732019-09-25 17:45:18 +0800129serial_initfunc(mtk_serial_initialize);
Marek Vasut419d8942012-09-12 13:50:56 +0200130
Marek Vasut95656ea2012-10-08 11:36:39 +0000131/**
132 * serial_register() - Register serial driver with serial driver core
133 * @dev: Pointer to the serial driver structure
134 *
135 * This function registers the serial driver supplied via @dev with
136 * serial driver core, thus making U-Boot aware of it and making it
137 * available for U-Boot to use. On platforms that still require manual
138 * relocation of constant variables, relocation of the supplied structure
139 * is performed.
140 */
Mike Frysingerffadc822011-04-29 18:03:30 +0000141void serial_register(struct serial_device *dev)
wdenk7ac16102004-08-01 22:48:16 +0000142{
Wolfgang Denkd0813e52010-10-28 20:00:11 +0200143#ifdef CONFIG_NEEDS_MANUAL_RELOC
Marek Vasut2206b342012-09-16 18:54:22 +0200144 if (dev->start)
145 dev->start += gd->reloc_off;
146 if (dev->stop)
147 dev->stop += gd->reloc_off;
148 if (dev->setbrg)
149 dev->setbrg += gd->reloc_off;
150 if (dev->getc)
151 dev->getc += gd->reloc_off;
152 if (dev->tstc)
153 dev->tstc += gd->reloc_off;
154 if (dev->putc)
155 dev->putc += gd->reloc_off;
156 if (dev->puts)
157 dev->puts += gd->reloc_off;
Peter Tyser9057cbf2009-09-21 11:20:36 -0500158#endif
wdenk7ac16102004-08-01 22:48:16 +0000159
160 dev->next = serial_devices;
161 serial_devices = dev;
wdenk7ac16102004-08-01 22:48:16 +0000162}
163
Marek Vasut95656ea2012-10-08 11:36:39 +0000164/**
165 * serial_initialize() - Register all compiled-in serial port drivers
166 *
167 * This function registers all serial port drivers that are compiled
168 * into the U-Boot binary with the serial core, thus making them
169 * available to U-Boot to use. Lastly, this function assigns a default
170 * serial port to the serial core. That serial port is then used as a
171 * default output.
172 */
Ovidiu Panait96008c92020-07-24 14:12:22 +0300173int serial_initialize(void)
wdenk7ac16102004-08-01 22:48:16 +0000174{
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100175 atmel_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100176 mcf_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100177 mpc85xx_serial_initialize();
Marek Vasut64c60552012-09-14 22:37:43 +0200178 mxc_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100179 ns16550_serial_initialize();
Marek Vasut46e4d5f2012-09-14 22:38:46 +0200180 pl01x_serial_initialize();
Jeroen Hofstee6512cc12014-10-27 20:10:07 +0100181 pxa_serial_initialize();
Marek Vasut904d3d72012-09-14 22:40:08 +0200182 sh_serial_initialize();
developer77c7c732019-09-25 17:45:18 +0800183 mtk_serial_initialize();
Marek Vasut01f9ea82012-09-13 01:16:50 +0200184
Gerlando Falauto34148d62011-11-18 06:49:11 +0000185 serial_assign(default_serial_console()->name);
Ovidiu Panait96008c92020-07-24 14:12:22 +0300186
187 return 0;
wdenk7ac16102004-08-01 22:48:16 +0000188}
189
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200190static int serial_stub_start(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600191{
192 struct serial_device *dev = sdev->priv;
193
194 return dev->start();
195}
196
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200197static int serial_stub_stop(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600198{
199 struct serial_device *dev = sdev->priv;
200
201 return dev->stop();
202}
203
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200204static void serial_stub_putc(struct stdio_dev *sdev, const char ch)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600205{
206 struct serial_device *dev = sdev->priv;
207
208 dev->putc(ch);
209}
210
Jeroen Hofstee169eda62014-10-08 22:57:44 +0200211static void serial_stub_puts(struct stdio_dev *sdev, const char *str)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600212{
213 struct serial_device *dev = sdev->priv;
214
215 dev->puts(str);
216}
217
Masahiro Yamada5e0ef842017-06-22 16:48:49 +0900218static int serial_stub_getc(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600219{
220 struct serial_device *dev = sdev->priv;
221
222 return dev->getc();
223}
224
Masahiro Yamada5e0ef842017-06-22 16:48:49 +0900225static int serial_stub_tstc(struct stdio_dev *sdev)
Simon Glass0d1e1f72014-07-23 06:54:59 -0600226{
227 struct serial_device *dev = sdev->priv;
228
229 return dev->tstc();
230}
231
Marek Vasut95656ea2012-10-08 11:36:39 +0000232/**
233 * serial_stdio_init() - Register serial ports with STDIO core
234 *
235 * This function generates a proxy driver for each serial port driver.
236 * These proxy drivers then register with the STDIO core, making the
237 * serial drivers available as STDIO devices.
238 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000239void serial_stdio_init(void)
wdenk7ac16102004-08-01 22:48:16 +0000240{
Jean-Christophe PLAGNIOL-VILLARD2a7a0312009-05-16 12:14:54 +0200241 struct stdio_dev dev;
wdenk7ac16102004-08-01 22:48:16 +0000242 struct serial_device *s = serial_devices;
243
wdenk8f08c5b2004-10-11 22:43:02 +0000244 while (s) {
Gerlando Falauto34148d62011-11-18 06:49:11 +0000245 memset(&dev, 0, sizeof(dev));
wdenk7ac16102004-08-01 22:48:16 +0000246
Gerlando Falauto34148d62011-11-18 06:49:11 +0000247 strcpy(dev.name, s->name);
wdenk7ac16102004-08-01 22:48:16 +0000248 dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
249
Simon Glass0d1e1f72014-07-23 06:54:59 -0600250 dev.start = serial_stub_start;
251 dev.stop = serial_stub_stop;
252 dev.putc = serial_stub_putc;
253 dev.puts = serial_stub_puts;
254 dev.getc = serial_stub_getc;
255 dev.tstc = serial_stub_tstc;
Simon Glassac2a14f2014-09-04 16:27:23 -0600256 dev.priv = s;
wdenk7ac16102004-08-01 22:48:16 +0000257
Gerlando Falauto34148d62011-11-18 06:49:11 +0000258 stdio_register(&dev);
wdenk7ac16102004-08-01 22:48:16 +0000259
260 s = s->next;
261 }
262}
263
Marek Vasut95656ea2012-10-08 11:36:39 +0000264/**
265 * serial_assign() - Select the serial output device by name
266 * @name: Name of the serial driver to be used as default output
267 *
268 * This function configures the serial output multiplexing by
269 * selecting which serial device will be used as default. In case
270 * the STDIO "serial" device is selected as stdin/stdout/stderr,
271 * the serial device previously configured by this function will be
272 * used for the particular operation.
273 *
274 * Returns 0 on success, negative on error.
275 */
Gerlando Falauto92999582011-11-18 06:49:12 +0000276int serial_assign(const char *name)
wdenk7ac16102004-08-01 22:48:16 +0000277{
278 struct serial_device *s;
279
wdenk8f08c5b2004-10-11 22:43:02 +0000280 for (s = serial_devices; s; s = s->next) {
Marek Vasut0e1b5772012-10-06 14:07:03 +0000281 if (strcmp(s->name, name))
282 continue;
283 serial_current = s;
284 return 0;
wdenk7ac16102004-08-01 22:48:16 +0000285 }
286
Marek Vasut0e1b5772012-10-06 14:07:03 +0000287 return -EINVAL;
wdenk7ac16102004-08-01 22:48:16 +0000288}
289
Marek Vasut95656ea2012-10-08 11:36:39 +0000290/**
291 * serial_reinit_all() - Reinitialize all compiled-in serial ports
292 *
293 * This function reinitializes all serial ports that are compiled
294 * into U-Boot by calling their serial_start() functions.
295 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000296void serial_reinit_all(void)
wdenk7ac16102004-08-01 22:48:16 +0000297{
298 struct serial_device *s;
299
Gerlando Falauto34148d62011-11-18 06:49:11 +0000300 for (s = serial_devices; s; s = s->next)
Marek Vasutb46931d2012-09-07 14:35:31 +0200301 s->start();
wdenk7ac16102004-08-01 22:48:16 +0000302}
303
Marek Vasut95656ea2012-10-08 11:36:39 +0000304/**
305 * get_current() - Return pointer to currently selected serial port
306 *
307 * This function returns a pointer to currently selected serial port.
308 * The currently selected serial port is altered by serial_assign()
309 * function.
310 *
311 * In case this function is called before relocation or before any serial
312 * port is configured, this function calls default_serial_console() to
313 * determine the serial port. Otherwise, the configured serial port is
314 * returned.
315 *
316 * Returns pointer to the currently selected serial port on success,
317 * NULL on error.
318 */
Simon Glass8f4e6f12011-08-19 11:09:43 +0000319static struct serial_device *get_current(void)
wdenk7ac16102004-08-01 22:48:16 +0000320{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000321 struct serial_device *dev;
322
Marek Vasutbdad8072012-10-06 14:07:04 +0000323 if (!(gd->flags & GD_FLG_RELOC))
Simon Glass8f4e6f12011-08-19 11:09:43 +0000324 dev = default_serial_console();
Marek Vasutbdad8072012-10-06 14:07:04 +0000325 else if (!serial_current)
326 dev = default_serial_console();
327 else
328 dev = serial_current;
wdenk8f08c5b2004-10-11 22:43:02 +0000329
Marek Vasutbdad8072012-10-06 14:07:04 +0000330 /* We must have a console device */
331 if (!dev) {
Marek Vasuta6f63342012-09-15 10:33:51 +0200332#ifdef CONFIG_SPL_BUILD
Marek Vasutbdad8072012-10-06 14:07:04 +0000333 puts("Cannot find console\n");
334 hang();
Marek Vasuta6f63342012-09-15 10:33:51 +0200335#else
Marek Vasutbdad8072012-10-06 14:07:04 +0000336 panic("Cannot find console\n");
Marek Vasuta6f63342012-09-15 10:33:51 +0200337#endif
Marek Vasutbdad8072012-10-06 14:07:04 +0000338 }
339
Simon Glass8f4e6f12011-08-19 11:09:43 +0000340 return dev;
341}
wdenk7ac16102004-08-01 22:48:16 +0000342
Marek Vasut95656ea2012-10-08 11:36:39 +0000343/**
344 * serial_init() - Initialize currently selected serial port
345 *
346 * This function initializes the currently selected serial port. This
347 * usually involves setting up the registers of that particular port,
348 * enabling clock and such. This function uses the get_current() call
349 * to determine which port is selected.
350 *
351 * Returns 0 on success, negative on error.
352 */
Simon Glass8f4e6f12011-08-19 11:09:43 +0000353int serial_init(void)
354{
Simon Glassb9d5f6b2014-07-23 06:55:07 -0600355 gd->flags |= GD_FLG_SERIAL_READY;
Marek Vasutb46931d2012-09-07 14:35:31 +0200356 return get_current()->start();
wdenk7ac16102004-08-01 22:48:16 +0000357}
358
Marek Vasut95656ea2012-10-08 11:36:39 +0000359/**
360 * serial_setbrg() - Configure baud-rate of currently selected serial port
361 *
362 * This function configures the baud-rate of the currently selected
363 * serial port. The baud-rate is retrieved from global data within
364 * the serial port driver. This function uses the get_current() call
365 * to determine which port is selected.
366 *
367 * Returns 0 on success, negative on error.
368 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000369void serial_setbrg(void)
wdenk7ac16102004-08-01 22:48:16 +0000370{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000371 get_current()->setbrg();
wdenk7ac16102004-08-01 22:48:16 +0000372}
373
Marek Vasut95656ea2012-10-08 11:36:39 +0000374/**
375 * serial_getc() - Read character from currently selected serial port
376 *
377 * This function retrieves a character from currently selected serial
378 * port. In case there is no character waiting on the serial port,
379 * this function will block and wait for the character to appear. This
380 * function uses the get_current() call to determine which port is
381 * selected.
382 *
383 * Returns the character on success, negative on error.
384 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000385int serial_getc(void)
wdenk7ac16102004-08-01 22:48:16 +0000386{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000387 return get_current()->getc();
wdenk7ac16102004-08-01 22:48:16 +0000388}
389
Marek Vasut95656ea2012-10-08 11:36:39 +0000390/**
391 * serial_tstc() - Test if data is available on currently selected serial port
392 *
393 * This function tests if one or more characters are available on
394 * currently selected serial port. This function never blocks. This
395 * function uses the get_current() call to determine which port is
396 * selected.
397 *
398 * Returns positive if character is available, zero otherwise.
399 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000400int serial_tstc(void)
wdenk7ac16102004-08-01 22:48:16 +0000401{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000402 return get_current()->tstc();
wdenk7ac16102004-08-01 22:48:16 +0000403}
404
Marek Vasut95656ea2012-10-08 11:36:39 +0000405/**
406 * serial_putc() - Output character via currently selected serial port
407 * @c: Single character to be output from the serial port.
408 *
409 * This function outputs a character via currently selected serial
410 * port. This character is passed to the serial port driver responsible
411 * for controlling the hardware. The hardware may still be in process
412 * of transmitting another character, therefore this function may block
413 * for a short amount of time. This function uses the get_current()
414 * call to determine which port is selected.
415 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000416void serial_putc(const char c)
wdenk7ac16102004-08-01 22:48:16 +0000417{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000418 get_current()->putc(c);
wdenk7ac16102004-08-01 22:48:16 +0000419}
420
Marek Vasut95656ea2012-10-08 11:36:39 +0000421/**
422 * serial_puts() - Output string via currently selected serial port
423 * @s: Zero-terminated string to be output from the serial port.
424 *
425 * This function outputs a zero-terminated string via currently
426 * selected serial port. This function behaves as an accelerator
427 * in case the hardware can queue multiple characters for transfer.
428 * The whole string that is to be output is available to the function
429 * implementing the hardware manipulation. Transmitting the whole
430 * string may take some time, thus this function may block for some
431 * amount of time. This function uses the get_current() call to
432 * determine which port is selected.
433 */
Gerlando Falauto34148d62011-11-18 06:49:11 +0000434void serial_puts(const char *s)
wdenk7ac16102004-08-01 22:48:16 +0000435{
Simon Glass8f4e6f12011-08-19 11:09:43 +0000436 get_current()->puts(s);
wdenk7ac16102004-08-01 22:48:16 +0000437}
Mike Frysinger078f2f12011-05-14 06:56:15 +0000438
Marek Vasut95656ea2012-10-08 11:36:39 +0000439/**
440 * default_serial_puts() - Output string by calling serial_putc() in loop
441 * @s: Zero-terminated string to be output from the serial port.
442 *
443 * This function outputs a zero-terminated string by calling serial_putc()
444 * in a loop. Most drivers do not support queueing more than one byte for
445 * transfer, thus this function precisely implements their serial_puts().
446 *
447 * To optimize the number of get_current() calls, this function only
448 * calls get_current() once and then directly accesses the putc() call
449 * of the &struct serial_device .
450 */
Marek Vasut6b9124e2012-10-06 14:07:01 +0000451void default_serial_puts(const char *s)
452{
453 struct serial_device *dev = get_current();
454 while (*s)
455 dev->putc(*s++);
456}
457
Mike Frysinger078f2f12011-05-14 06:56:15 +0000458#if CONFIG_POST & CONFIG_SYS_POST_UART
459static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE;
460
Marek Vasut95656ea2012-10-08 11:36:39 +0000461/**
462 * uart_post_test() - Test the currently selected serial port using POST
463 * @flags: POST framework flags
464 *
465 * Do a loopback test of the currently selected serial port. This
466 * function is only useful in the context of the POST testing framwork.
Vagrant Cascadianbeb288b2015-11-24 14:46:24 -0800467 * The serial port is first configured into loopback mode and then
Marek Vasut95656ea2012-10-08 11:36:39 +0000468 * characters are sent through it.
469 *
470 * Returns 0 on success, value otherwise.
471 */
Mike Frysinger078f2f12011-05-14 06:56:15 +0000472/* Mark weak until post/cpu/.../uart.c migrate over */
473__weak
474int uart_post_test(int flags)
475{
476 unsigned char c;
477 int ret, saved_baud, b;
478 struct serial_device *saved_dev, *s;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000479
480 /* Save current serial state */
481 ret = 0;
482 saved_dev = serial_current;
Masahiro Yamada197c7202014-04-04 20:09:58 +0900483 saved_baud = gd->baudrate;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000484
485 for (s = serial_devices; s; s = s->next) {
486 /* If this driver doesn't support loop back, skip it */
487 if (!s->loop)
488 continue;
489
490 /* Test the next device */
491 serial_current = s;
492
493 ret = serial_init();
494 if (ret)
495 goto done;
496
497 /* Consume anything that happens to be queued */
498 while (serial_tstc())
499 serial_getc();
500
501 /* Enable loop back */
502 s->loop(1);
503
504 /* Test every available baud rate */
505 for (b = 0; b < ARRAY_SIZE(bauds); ++b) {
Masahiro Yamada197c7202014-04-04 20:09:58 +0900506 gd->baudrate = bauds[b];
Mike Frysinger078f2f12011-05-14 06:56:15 +0000507 serial_setbrg();
508
509 /*
510 * Stick to printable chars to avoid issues:
511 * - terminal corruption
512 * - serial program reacting to sequences and sending
513 * back random extra data
514 * - most serial drivers add in extra chars (like \r\n)
515 */
516 for (c = 0x20; c < 0x7f; ++c) {
517 /* Send it out */
518 serial_putc(c);
519
520 /* Make sure it's the same one */
521 ret = (c != serial_getc());
522 if (ret) {
523 s->loop(0);
524 goto done;
525 }
526
527 /* Clean up the output in case it was sent */
528 serial_putc('\b');
529 ret = ('\b' != serial_getc());
530 if (ret) {
531 s->loop(0);
532 goto done;
533 }
534 }
535 }
536
537 /* Disable loop back */
538 s->loop(0);
539
Marek Vasutb46931d2012-09-07 14:35:31 +0200540 /* XXX: There is no serial_stop() !? */
541 if (s->stop)
542 s->stop();
Mike Frysinger078f2f12011-05-14 06:56:15 +0000543 }
544
545 done:
546 /* Restore previous serial state */
547 serial_current = saved_dev;
Masahiro Yamada197c7202014-04-04 20:09:58 +0900548 gd->baudrate = saved_baud;
Mike Frysinger078f2f12011-05-14 06:56:15 +0000549 serial_reinit_all();
550 serial_setbrg();
551
552 return ret;
553}
554#endif