]>
Commit | Line | Data |
---|---|---|
281e00a3 WD |
1 | /* |
2 | * (C) Copyright 2004 | |
3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
4 | * | |
1a459660 | 5 | * SPDX-License-Identifier: GPL-2.0+ |
281e00a3 WD |
6 | */ |
7 | ||
8 | #include <common.h> | |
32057717 | 9 | #include <environment.h> |
281e00a3 | 10 | #include <serial.h> |
52cb4d4f | 11 | #include <stdio_dev.h> |
7b826c2f MF |
12 | #include <post.h> |
13 | #include <linux/compiler.h> | |
6d93e258 | 14 | #include <errno.h> |
281e00a3 | 15 | |
d87080b7 WD |
16 | DECLARE_GLOBAL_DATA_PTR; |
17 | ||
a6e6f7f4 GF |
18 | static struct serial_device *serial_devices; |
19 | static struct serial_device *serial_current; | |
32057717 JH |
20 | /* |
21 | * Table with supported baudrates (defined in config_xyz.h) | |
22 | */ | |
23 | static const unsigned long baudrate_table[] = CONFIG_SYS_BAUDRATE_TABLE; | |
281e00a3 | 24 | |
9cd2b9e4 MV |
25 | /** |
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 | */ | |
2a333aeb MV |
33 | static void serial_null(void) |
34 | { | |
35 | } | |
36 | ||
32057717 JH |
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 | */ | |
42 | static 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 | ||
9935175f | 60 | for (i = 0; i < ARRAY_SIZE(baudrate_table); ++i) { |
32057717 JH |
61 | if (baudrate == baudrate_table[i]) |
62 | break; | |
63 | } | |
9935175f | 64 | if (i == ARRAY_SIZE(baudrate_table)) { |
32057717 JH |
65 | 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; | |
32057717 JH |
77 | |
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 | } | |
95 | } | |
96 | U_BOOT_ENV_CALLBACK(baudrate, on_baudrate); | |
97 | ||
9cd2b9e4 MV |
98 | /** |
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 | */ | |
2a333aeb MV |
108 | #define serial_initfunc(name) \ |
109 | void name(void) \ | |
110 | __attribute__((weak, alias("serial_null"))); | |
111 | ||
f0eb1f61 | 112 | serial_initfunc(mpc8xx_serial_initialize); |
abc0ed8d | 113 | serial_initfunc(ns16550_serial_initialize); |
1fe5c110 | 114 | serial_initfunc(pxa_serial_initialize); |
28af6385 | 115 | serial_initfunc(s3c24xx_serial_initialize); |
b4980515 | 116 | serial_initfunc(s5p_serial_initialize); |
870e0bda | 117 | serial_initfunc(zynq_serial_initialize); |
5ae1de0d | 118 | serial_initfunc(bfin_serial_initialize); |
41651cab | 119 | serial_initfunc(bfin_jtag_initialize); |
918327c8 | 120 | serial_initfunc(mpc512x_serial_initialize); |
87d69229 | 121 | serial_initfunc(uartlite_serial_initialize); |
7b953c51 | 122 | serial_initfunc(au1x00_serial_initialize); |
01911422 | 123 | serial_initfunc(asc_serial_initialize); |
6cb3273d | 124 | serial_initfunc(jz_serial_initialize); |
b57c6528 | 125 | serial_initfunc(mpc5xx_serial_initialize); |
d68f4da2 MV |
126 | serial_initfunc(mpc8260_scc_serial_initialize); |
127 | serial_initfunc(mpc8260_smc_serial_initialize); | |
7a311546 | 128 | serial_initfunc(mpc85xx_serial_initialize); |
fcc2074d | 129 | serial_initfunc(iop480_serial_initialize); |
af7be3b6 | 130 | serial_initfunc(leon2_serial_initialize); |
29b5ff7f | 131 | serial_initfunc(leon3_serial_initialize); |
afe4c389 | 132 | serial_initfunc(marvell_serial_initialize); |
5dee6f55 | 133 | serial_initfunc(amirix_serial_initialize); |
c45a14ad | 134 | serial_initfunc(bmw_serial_initialize); |
d25c39d3 | 135 | serial_initfunc(cogent_serial_initialize); |
619c90bb | 136 | serial_initfunc(cpci750_serial_initialize); |
829b3b2e | 137 | serial_initfunc(evb64260_serial_initialize); |
d126f285 | 138 | serial_initfunc(ml2_serial_initialize); |
26d8eaaa | 139 | serial_initfunc(sconsole_serial_initialize); |
088a4f3c | 140 | serial_initfunc(p3mx_serial_initialize); |
8c085757 | 141 | serial_initfunc(altera_jtag_serial_initialize); |
b207d645 | 142 | serial_initfunc(altera_serial_initialize); |
cfba4573 | 143 | serial_initfunc(atmel_serial_initialize); |
e503f90a | 144 | serial_initfunc(lpc32xx_serial_initialize); |
abaef69f | 145 | serial_initfunc(mcf_serial_initialize); |
69ea8070 | 146 | serial_initfunc(oc_serial_initialize); |
cef46b77 | 147 | serial_initfunc(sandbox_serial_initialize); |
8b029db8 | 148 | serial_initfunc(clps7111_serial_initialize); |
7882e7c1 | 149 | serial_initfunc(imx_serial_initialize); |
a7ffb2fc | 150 | serial_initfunc(ks8695_serial_initialize); |
1f673b4f | 151 | serial_initfunc(lh7a40x_serial_initialize); |
7cd851a5 | 152 | serial_initfunc(max3100_serial_initialize); |
a943472c | 153 | serial_initfunc(mxc_serial_initialize); |
39f61477 | 154 | serial_initfunc(pl01x_serial_initialize); |
a30a4220 | 155 | serial_initfunc(sa1100_serial_initialize); |
8bdd7efa | 156 | serial_initfunc(sh_serial_initialize); |
a168d3af | 157 | serial_initfunc(arm_dcc_initialize); |
661edaaf | 158 | serial_initfunc(mxs_auart_initialize); |
22a240c3 | 159 | serial_initfunc(arc_serial_initialize); |
f0eb1f61 | 160 | |
9cd2b9e4 MV |
161 | /** |
162 | * serial_register() - Register serial driver with serial driver core | |
163 | * @dev: Pointer to the serial driver structure | |
164 | * | |
165 | * This function registers the serial driver supplied via @dev with | |
166 | * serial driver core, thus making U-Boot aware of it and making it | |
167 | * available for U-Boot to use. On platforms that still require manual | |
168 | * relocation of constant variables, relocation of the supplied structure | |
169 | * is performed. | |
170 | */ | |
c52b4f79 | 171 | void serial_register(struct serial_device *dev) |
281e00a3 | 172 | { |
2e5167cc | 173 | #ifdef CONFIG_NEEDS_MANUAL_RELOC |
f2760c4a MV |
174 | if (dev->start) |
175 | dev->start += gd->reloc_off; | |
176 | if (dev->stop) | |
177 | dev->stop += gd->reloc_off; | |
178 | if (dev->setbrg) | |
179 | dev->setbrg += gd->reloc_off; | |
180 | if (dev->getc) | |
181 | dev->getc += gd->reloc_off; | |
182 | if (dev->tstc) | |
183 | dev->tstc += gd->reloc_off; | |
184 | if (dev->putc) | |
185 | dev->putc += gd->reloc_off; | |
186 | if (dev->puts) | |
187 | dev->puts += gd->reloc_off; | |
521af04d | 188 | #endif |
281e00a3 WD |
189 | |
190 | dev->next = serial_devices; | |
191 | serial_devices = dev; | |
281e00a3 WD |
192 | } |
193 | ||
9cd2b9e4 MV |
194 | /** |
195 | * serial_initialize() - Register all compiled-in serial port drivers | |
196 | * | |
197 | * This function registers all serial port drivers that are compiled | |
198 | * into the U-Boot binary with the serial core, thus making them | |
199 | * available to U-Boot to use. Lastly, this function assigns a default | |
200 | * serial port to the serial core. That serial port is then used as a | |
201 | * default output. | |
202 | */ | |
a6e6f7f4 | 203 | void serial_initialize(void) |
281e00a3 | 204 | { |
f0eb1f61 | 205 | mpc8xx_serial_initialize(); |
abc0ed8d | 206 | ns16550_serial_initialize(); |
1fe5c110 | 207 | pxa_serial_initialize(); |
28af6385 | 208 | s3c24xx_serial_initialize(); |
b4980515 | 209 | s5p_serial_initialize(); |
918327c8 | 210 | mpc512x_serial_initialize(); |
5ae1de0d | 211 | bfin_serial_initialize(); |
41651cab | 212 | bfin_jtag_initialize(); |
87d69229 | 213 | uartlite_serial_initialize(); |
870e0bda | 214 | zynq_serial_initialize(); |
7b953c51 | 215 | au1x00_serial_initialize(); |
01911422 | 216 | asc_serial_initialize(); |
6cb3273d | 217 | jz_serial_initialize(); |
b57c6528 | 218 | mpc5xx_serial_initialize(); |
d68f4da2 MV |
219 | mpc8260_scc_serial_initialize(); |
220 | mpc8260_smc_serial_initialize(); | |
7a311546 | 221 | mpc85xx_serial_initialize(); |
fcc2074d | 222 | iop480_serial_initialize(); |
af7be3b6 | 223 | leon2_serial_initialize(); |
29b5ff7f | 224 | leon3_serial_initialize(); |
afe4c389 | 225 | marvell_serial_initialize(); |
5dee6f55 | 226 | amirix_serial_initialize(); |
c45a14ad | 227 | bmw_serial_initialize(); |
d25c39d3 | 228 | cogent_serial_initialize(); |
619c90bb | 229 | cpci750_serial_initialize(); |
829b3b2e | 230 | evb64260_serial_initialize(); |
d126f285 | 231 | ml2_serial_initialize(); |
26d8eaaa | 232 | sconsole_serial_initialize(); |
088a4f3c | 233 | p3mx_serial_initialize(); |
8c085757 | 234 | altera_jtag_serial_initialize(); |
b207d645 | 235 | altera_serial_initialize(); |
cfba4573 | 236 | atmel_serial_initialize(); |
e503f90a | 237 | lpc32xx_serial_initialize(); |
abaef69f | 238 | mcf_serial_initialize(); |
69ea8070 | 239 | oc_serial_initialize(); |
cef46b77 | 240 | sandbox_serial_initialize(); |
8b029db8 | 241 | clps7111_serial_initialize(); |
7882e7c1 | 242 | imx_serial_initialize(); |
a7ffb2fc | 243 | ks8695_serial_initialize(); |
1f673b4f | 244 | lh7a40x_serial_initialize(); |
7cd851a5 | 245 | max3100_serial_initialize(); |
a943472c | 246 | mxc_serial_initialize(); |
39f61477 | 247 | pl01x_serial_initialize(); |
a30a4220 | 248 | sa1100_serial_initialize(); |
8bdd7efa | 249 | sh_serial_initialize(); |
a168d3af | 250 | arm_dcc_initialize(); |
661edaaf | 251 | mxs_auart_initialize(); |
22a240c3 | 252 | arc_serial_initialize(); |
7b953c51 | 253 | |
a6e6f7f4 | 254 | serial_assign(default_serial_console()->name); |
281e00a3 WD |
255 | } |
256 | ||
709ea543 SG |
257 | int serial_stub_start(struct stdio_dev *sdev) |
258 | { | |
259 | struct serial_device *dev = sdev->priv; | |
260 | ||
261 | return dev->start(); | |
262 | } | |
263 | ||
264 | int serial_stub_stop(struct stdio_dev *sdev) | |
265 | { | |
266 | struct serial_device *dev = sdev->priv; | |
267 | ||
268 | return dev->stop(); | |
269 | } | |
270 | ||
271 | void serial_stub_putc(struct stdio_dev *sdev, const char ch) | |
272 | { | |
273 | struct serial_device *dev = sdev->priv; | |
274 | ||
275 | dev->putc(ch); | |
276 | } | |
277 | ||
278 | void serial_stub_puts(struct stdio_dev *sdev, const char *str) | |
279 | { | |
280 | struct serial_device *dev = sdev->priv; | |
281 | ||
282 | dev->puts(str); | |
283 | } | |
284 | ||
285 | int serial_stub_getc(struct stdio_dev *sdev) | |
286 | { | |
287 | struct serial_device *dev = sdev->priv; | |
288 | ||
289 | return dev->getc(); | |
290 | } | |
291 | ||
292 | int serial_stub_tstc(struct stdio_dev *sdev) | |
293 | { | |
294 | struct serial_device *dev = sdev->priv; | |
295 | ||
296 | return dev->tstc(); | |
297 | } | |
298 | ||
9cd2b9e4 MV |
299 | /** |
300 | * serial_stdio_init() - Register serial ports with STDIO core | |
301 | * | |
302 | * This function generates a proxy driver for each serial port driver. | |
303 | * These proxy drivers then register with the STDIO core, making the | |
304 | * serial drivers available as STDIO devices. | |
305 | */ | |
a6e6f7f4 | 306 | void serial_stdio_init(void) |
281e00a3 | 307 | { |
52cb4d4f | 308 | struct stdio_dev dev; |
281e00a3 WD |
309 | struct serial_device *s = serial_devices; |
310 | ||
2ee66533 | 311 | while (s) { |
a6e6f7f4 | 312 | memset(&dev, 0, sizeof(dev)); |
281e00a3 | 313 | |
a6e6f7f4 | 314 | strcpy(dev.name, s->name); |
281e00a3 WD |
315 | dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT; |
316 | ||
709ea543 SG |
317 | dev.start = serial_stub_start; |
318 | dev.stop = serial_stub_stop; | |
319 | dev.putc = serial_stub_putc; | |
320 | dev.puts = serial_stub_puts; | |
321 | dev.getc = serial_stub_getc; | |
322 | dev.tstc = serial_stub_tstc; | |
281e00a3 | 323 | |
a6e6f7f4 | 324 | stdio_register(&dev); |
281e00a3 WD |
325 | |
326 | s = s->next; | |
327 | } | |
328 | } | |
329 | ||
9cd2b9e4 MV |
330 | /** |
331 | * serial_assign() - Select the serial output device by name | |
332 | * @name: Name of the serial driver to be used as default output | |
333 | * | |
334 | * This function configures the serial output multiplexing by | |
335 | * selecting which serial device will be used as default. In case | |
336 | * the STDIO "serial" device is selected as stdin/stdout/stderr, | |
337 | * the serial device previously configured by this function will be | |
338 | * used for the particular operation. | |
339 | * | |
340 | * Returns 0 on success, negative on error. | |
341 | */ | |
7813ca9b | 342 | int serial_assign(const char *name) |
281e00a3 WD |
343 | { |
344 | struct serial_device *s; | |
345 | ||
2ee66533 | 346 | for (s = serial_devices; s; s = s->next) { |
6d93e258 MV |
347 | if (strcmp(s->name, name)) |
348 | continue; | |
349 | serial_current = s; | |
350 | return 0; | |
281e00a3 WD |
351 | } |
352 | ||
6d93e258 | 353 | return -EINVAL; |
281e00a3 WD |
354 | } |
355 | ||
9cd2b9e4 MV |
356 | /** |
357 | * serial_reinit_all() - Reinitialize all compiled-in serial ports | |
358 | * | |
359 | * This function reinitializes all serial ports that are compiled | |
360 | * into U-Boot by calling their serial_start() functions. | |
361 | */ | |
a6e6f7f4 | 362 | void serial_reinit_all(void) |
281e00a3 WD |
363 | { |
364 | struct serial_device *s; | |
365 | ||
a6e6f7f4 | 366 | for (s = serial_devices; s; s = s->next) |
89143fb3 | 367 | s->start(); |
281e00a3 WD |
368 | } |
369 | ||
9cd2b9e4 MV |
370 | /** |
371 | * get_current() - Return pointer to currently selected serial port | |
372 | * | |
373 | * This function returns a pointer to currently selected serial port. | |
374 | * The currently selected serial port is altered by serial_assign() | |
375 | * function. | |
376 | * | |
377 | * In case this function is called before relocation or before any serial | |
378 | * port is configured, this function calls default_serial_console() to | |
379 | * determine the serial port. Otherwise, the configured serial port is | |
380 | * returned. | |
381 | * | |
382 | * Returns pointer to the currently selected serial port on success, | |
383 | * NULL on error. | |
384 | */ | |
857c283e | 385 | static struct serial_device *get_current(void) |
281e00a3 | 386 | { |
857c283e | 387 | struct serial_device *dev; |
2ee66533 | 388 | |
dee19416 | 389 | if (!(gd->flags & GD_FLG_RELOC)) |
857c283e | 390 | dev = default_serial_console(); |
dee19416 MV |
391 | else if (!serial_current) |
392 | dev = default_serial_console(); | |
393 | else | |
394 | dev = serial_current; | |
857c283e | 395 | |
dee19416 MV |
396 | /* We must have a console device */ |
397 | if (!dev) { | |
f1f1e9cb | 398 | #ifdef CONFIG_SPL_BUILD |
dee19416 MV |
399 | puts("Cannot find console\n"); |
400 | hang(); | |
f1f1e9cb | 401 | #else |
dee19416 | 402 | panic("Cannot find console\n"); |
f1f1e9cb | 403 | #endif |
dee19416 MV |
404 | } |
405 | ||
857c283e SG |
406 | return dev; |
407 | } | |
281e00a3 | 408 | |
9cd2b9e4 MV |
409 | /** |
410 | * serial_init() - Initialize currently selected serial port | |
411 | * | |
412 | * This function initializes the currently selected serial port. This | |
413 | * usually involves setting up the registers of that particular port, | |
414 | * enabling clock and such. This function uses the get_current() call | |
415 | * to determine which port is selected. | |
416 | * | |
417 | * Returns 0 on success, negative on error. | |
418 | */ | |
857c283e SG |
419 | int serial_init(void) |
420 | { | |
89143fb3 | 421 | return get_current()->start(); |
281e00a3 WD |
422 | } |
423 | ||
9cd2b9e4 MV |
424 | /** |
425 | * serial_setbrg() - Configure baud-rate of currently selected serial port | |
426 | * | |
427 | * This function configures the baud-rate of the currently selected | |
428 | * serial port. The baud-rate is retrieved from global data within | |
429 | * the serial port driver. This function uses the get_current() call | |
430 | * to determine which port is selected. | |
431 | * | |
432 | * Returns 0 on success, negative on error. | |
433 | */ | |
a6e6f7f4 | 434 | void serial_setbrg(void) |
281e00a3 | 435 | { |
857c283e | 436 | get_current()->setbrg(); |
281e00a3 WD |
437 | } |
438 | ||
9cd2b9e4 MV |
439 | /** |
440 | * serial_getc() - Read character from currently selected serial port | |
441 | * | |
442 | * This function retrieves a character from currently selected serial | |
443 | * port. In case there is no character waiting on the serial port, | |
444 | * this function will block and wait for the character to appear. This | |
445 | * function uses the get_current() call to determine which port is | |
446 | * selected. | |
447 | * | |
448 | * Returns the character on success, negative on error. | |
449 | */ | |
a6e6f7f4 | 450 | int serial_getc(void) |
281e00a3 | 451 | { |
857c283e | 452 | return get_current()->getc(); |
281e00a3 WD |
453 | } |
454 | ||
9cd2b9e4 MV |
455 | /** |
456 | * serial_tstc() - Test if data is available on currently selected serial port | |
457 | * | |
458 | * This function tests if one or more characters are available on | |
459 | * currently selected serial port. This function never blocks. This | |
460 | * function uses the get_current() call to determine which port is | |
461 | * selected. | |
462 | * | |
463 | * Returns positive if character is available, zero otherwise. | |
464 | */ | |
a6e6f7f4 | 465 | int serial_tstc(void) |
281e00a3 | 466 | { |
857c283e | 467 | return get_current()->tstc(); |
281e00a3 WD |
468 | } |
469 | ||
9cd2b9e4 MV |
470 | /** |
471 | * serial_putc() - Output character via currently selected serial port | |
472 | * @c: Single character to be output from the serial port. | |
473 | * | |
474 | * This function outputs a character via currently selected serial | |
475 | * port. This character is passed to the serial port driver responsible | |
476 | * for controlling the hardware. The hardware may still be in process | |
477 | * of transmitting another character, therefore this function may block | |
478 | * for a short amount of time. This function uses the get_current() | |
479 | * call to determine which port is selected. | |
480 | */ | |
a6e6f7f4 | 481 | void serial_putc(const char c) |
281e00a3 | 482 | { |
857c283e | 483 | get_current()->putc(c); |
281e00a3 WD |
484 | } |
485 | ||
9cd2b9e4 MV |
486 | /** |
487 | * serial_puts() - Output string via currently selected serial port | |
488 | * @s: Zero-terminated string to be output from the serial port. | |
489 | * | |
490 | * This function outputs a zero-terminated string via currently | |
491 | * selected serial port. This function behaves as an accelerator | |
492 | * in case the hardware can queue multiple characters for transfer. | |
493 | * The whole string that is to be output is available to the function | |
494 | * implementing the hardware manipulation. Transmitting the whole | |
495 | * string may take some time, thus this function may block for some | |
496 | * amount of time. This function uses the get_current() call to | |
497 | * determine which port is selected. | |
498 | */ | |
a6e6f7f4 | 499 | void serial_puts(const char *s) |
281e00a3 | 500 | { |
857c283e | 501 | get_current()->puts(s); |
281e00a3 | 502 | } |
7b826c2f | 503 | |
9cd2b9e4 MV |
504 | /** |
505 | * default_serial_puts() - Output string by calling serial_putc() in loop | |
506 | * @s: Zero-terminated string to be output from the serial port. | |
507 | * | |
508 | * This function outputs a zero-terminated string by calling serial_putc() | |
509 | * in a loop. Most drivers do not support queueing more than one byte for | |
510 | * transfer, thus this function precisely implements their serial_puts(). | |
511 | * | |
512 | * To optimize the number of get_current() calls, this function only | |
513 | * calls get_current() once and then directly accesses the putc() call | |
514 | * of the &struct serial_device . | |
515 | */ | |
bfb7d7a3 MV |
516 | void default_serial_puts(const char *s) |
517 | { | |
518 | struct serial_device *dev = get_current(); | |
519 | while (*s) | |
520 | dev->putc(*s++); | |
521 | } | |
522 | ||
7b826c2f MF |
523 | #if CONFIG_POST & CONFIG_SYS_POST_UART |
524 | static const int bauds[] = CONFIG_SYS_BAUDRATE_TABLE; | |
525 | ||
9cd2b9e4 MV |
526 | /** |
527 | * uart_post_test() - Test the currently selected serial port using POST | |
528 | * @flags: POST framework flags | |
529 | * | |
530 | * Do a loopback test of the currently selected serial port. This | |
531 | * function is only useful in the context of the POST testing framwork. | |
532 | * The serial port is firstly configured into loopback mode and then | |
533 | * characters are sent through it. | |
534 | * | |
535 | * Returns 0 on success, value otherwise. | |
536 | */ | |
7b826c2f MF |
537 | /* Mark weak until post/cpu/.../uart.c migrate over */ |
538 | __weak | |
539 | int uart_post_test(int flags) | |
540 | { | |
541 | unsigned char c; | |
542 | int ret, saved_baud, b; | |
543 | struct serial_device *saved_dev, *s; | |
7b826c2f MF |
544 | |
545 | /* Save current serial state */ | |
546 | ret = 0; | |
547 | saved_dev = serial_current; | |
8e261575 | 548 | saved_baud = gd->baudrate; |
7b826c2f MF |
549 | |
550 | for (s = serial_devices; s; s = s->next) { | |
551 | /* If this driver doesn't support loop back, skip it */ | |
552 | if (!s->loop) | |
553 | continue; | |
554 | ||
555 | /* Test the next device */ | |
556 | serial_current = s; | |
557 | ||
558 | ret = serial_init(); | |
559 | if (ret) | |
560 | goto done; | |
561 | ||
562 | /* Consume anything that happens to be queued */ | |
563 | while (serial_tstc()) | |
564 | serial_getc(); | |
565 | ||
566 | /* Enable loop back */ | |
567 | s->loop(1); | |
568 | ||
569 | /* Test every available baud rate */ | |
570 | for (b = 0; b < ARRAY_SIZE(bauds); ++b) { | |
8e261575 | 571 | gd->baudrate = bauds[b]; |
7b826c2f MF |
572 | serial_setbrg(); |
573 | ||
574 | /* | |
575 | * Stick to printable chars to avoid issues: | |
576 | * - terminal corruption | |
577 | * - serial program reacting to sequences and sending | |
578 | * back random extra data | |
579 | * - most serial drivers add in extra chars (like \r\n) | |
580 | */ | |
581 | for (c = 0x20; c < 0x7f; ++c) { | |
582 | /* Send it out */ | |
583 | serial_putc(c); | |
584 | ||
585 | /* Make sure it's the same one */ | |
586 | ret = (c != serial_getc()); | |
587 | if (ret) { | |
588 | s->loop(0); | |
589 | goto done; | |
590 | } | |
591 | ||
592 | /* Clean up the output in case it was sent */ | |
593 | serial_putc('\b'); | |
594 | ret = ('\b' != serial_getc()); | |
595 | if (ret) { | |
596 | s->loop(0); | |
597 | goto done; | |
598 | } | |
599 | } | |
600 | } | |
601 | ||
602 | /* Disable loop back */ | |
603 | s->loop(0); | |
604 | ||
89143fb3 MV |
605 | /* XXX: There is no serial_stop() !? */ |
606 | if (s->stop) | |
607 | s->stop(); | |
7b826c2f MF |
608 | } |
609 | ||
610 | done: | |
611 | /* Restore previous serial state */ | |
612 | serial_current = saved_dev; | |
8e261575 | 613 | gd->baudrate = saved_baud; |
7b826c2f MF |
614 | serial_reinit_all(); |
615 | serial_setbrg(); | |
616 | ||
617 | return ret; | |
618 | } | |
619 | #endif |