2 * Copyright (c) 2014 The Chromium OS Authors.
4 * SPDX-License-Identifier: GPL-2.0+
9 #include <environment.h>
14 #include <stdio_dev.h>
17 #include <dm/device-internal.h>
19 DECLARE_GLOBAL_DATA_PTR
;
22 * Table with supported baudrates (defined in config_xyz.h)
24 static const unsigned long baudrate_table
[] = CONFIG_SYS_BAUDRATE_TABLE
;
26 #ifndef CONFIG_SYS_MALLOC_F_LEN
27 #error "Serial is required before relocation - define CONFIG_SYS_MALLOC_F_LEN to make this work"
30 static void serial_find_console_or_panic(void)
34 #ifdef CONFIG_OF_CONTROL
37 /* Check for a chosen console */
38 node
= fdtdec_get_chosen_node(gd
->fdt_blob
, "stdout-path");
40 node
= fdt_path_offset(gd
->fdt_blob
, "console");
41 if (!uclass_get_device_by_of_offset(UCLASS_SERIAL
, node
, &dev
)) {
42 gd
->cur_serial_dev
= dev
;
47 * If the console is not marked to be bound before relocation, bind
51 !lists_bind_fdt(gd
->dm_root
, gd
->fdt_blob
, node
, &dev
)) {
52 if (!device_probe(dev
)) {
53 gd
->cur_serial_dev
= dev
;
59 * Try to use CONFIG_CONS_INDEX if available (it is numbered from 1!).
61 * Failing that, get the device with sequence number 0, or in extremis
62 * just the first serial device we can find. But we insist on having
63 * a console (even if it is silent).
65 #ifdef CONFIG_CONS_INDEX
66 #define INDEX (CONFIG_CONS_INDEX - 1)
70 if (uclass_get_device_by_seq(UCLASS_SERIAL
, INDEX
, &dev
) &&
71 uclass_get_device(UCLASS_SERIAL
, INDEX
, &dev
) &&
72 (uclass_first_device(UCLASS_SERIAL
, &dev
) || !dev
))
73 panic("No serial driver found");
75 gd
->cur_serial_dev
= dev
;
78 /* Called prior to relocation */
81 serial_find_console_or_panic();
82 gd
->flags
|= GD_FLG_SERIAL_READY
;
87 /* Called after relocation */
88 void serial_initialize(void)
90 serial_find_console_or_panic();
93 static void _serial_putc(struct udevice
*dev
, char ch
)
95 struct dm_serial_ops
*ops
= serial_get_ops(dev
);
99 err
= ops
->putc(dev
, ch
);
100 } while (err
== -EAGAIN
);
102 _serial_putc(dev
, '\r');
105 static void _serial_puts(struct udevice
*dev
, const char *str
)
108 _serial_putc(dev
, *str
++);
111 static int _serial_getc(struct udevice
*dev
)
113 struct dm_serial_ops
*ops
= serial_get_ops(dev
);
117 err
= ops
->getc(dev
);
120 } while (err
== -EAGAIN
);
122 return err
>= 0 ? err
: 0;
125 static int _serial_tstc(struct udevice
*dev
)
127 struct dm_serial_ops
*ops
= serial_get_ops(dev
);
130 return ops
->pending(dev
, true);
135 void serial_putc(char ch
)
137 _serial_putc(gd
->cur_serial_dev
, ch
);
140 void serial_puts(const char *str
)
142 _serial_puts(gd
->cur_serial_dev
, str
);
145 int serial_getc(void)
147 return _serial_getc(gd
->cur_serial_dev
);
150 int serial_tstc(void)
152 return _serial_tstc(gd
->cur_serial_dev
);
155 void serial_setbrg(void)
157 struct dm_serial_ops
*ops
= serial_get_ops(gd
->cur_serial_dev
);
160 ops
->setbrg(gd
->cur_serial_dev
, gd
->baudrate
);
163 void serial_stdio_init(void)
167 #ifdef CONFIG_DM_STDIO
168 static void serial_stub_putc(struct stdio_dev
*sdev
, const char ch
)
170 _serial_putc(sdev
->priv
, ch
);
174 void serial_stub_puts(struct stdio_dev
*sdev
, const char *str
)
176 _serial_puts(sdev
->priv
, str
);
179 int serial_stub_getc(struct stdio_dev
*sdev
)
181 return _serial_getc(sdev
->priv
);
184 int serial_stub_tstc(struct stdio_dev
*sdev
)
186 return _serial_tstc(sdev
->priv
);
190 * on_baudrate() - Update the actual baudrate when the env var changes
192 * This will check for a valid baudrate and only apply it if valid.
194 static int on_baudrate(const char *name
, const char *value
, enum env_op op
,
202 case env_op_overwrite
:
204 * Switch to new baudrate if new baudrate is supported
206 baudrate
= simple_strtoul(value
, NULL
, 10);
208 /* Not actually changing */
209 if (gd
->baudrate
== baudrate
)
212 for (i
= 0; i
< ARRAY_SIZE(baudrate_table
); ++i
) {
213 if (baudrate
== baudrate_table
[i
])
216 if (i
== ARRAY_SIZE(baudrate_table
)) {
217 if ((flags
& H_FORCE
) == 0)
218 printf("## Baudrate %d bps not supported\n",
222 if ((flags
& H_INTERACTIVE
) != 0) {
223 printf("## Switch baudrate to %d bps and press ENTER ...\n",
228 gd
->baudrate
= baudrate
;
234 if ((flags
& H_INTERACTIVE
) != 0)
242 printf("## Baudrate may not be deleted\n");
248 U_BOOT_ENV_CALLBACK(baudrate
, on_baudrate
);
250 static int serial_post_probe(struct udevice
*dev
)
252 struct dm_serial_ops
*ops
= serial_get_ops(dev
);
253 #ifdef CONFIG_DM_STDIO
254 struct serial_dev_priv
*upriv
= dev_get_uclass_priv(dev
);
255 struct stdio_dev sdev
;
259 #if defined(CONFIG_NEEDS_MANUAL_RELOC)
261 ops
->setbrg
+= gd
->reloc_off
;
263 ops
->getc
+= gd
->reloc_off
;
265 ops
->putc
+= gd
->reloc_off
;
267 ops
->pending
+= gd
->reloc_off
;
269 ops
->clear
+= gd
->reloc_off
;
270 #if CONFIG_POST & CONFIG_SYS_POST_UART
272 ops
->loop
+= gd
->reloc_off
275 /* Set the baud rate */
277 ret
= ops
->setbrg(dev
, gd
->baudrate
);
282 #ifdef CONFIG_DM_STDIO
283 if (!(gd
->flags
& GD_FLG_RELOC
))
285 memset(&sdev
, '\0', sizeof(sdev
));
287 strncpy(sdev
.name
, dev
->name
, sizeof(sdev
.name
));
288 sdev
.flags
= DEV_FLAGS_OUTPUT
| DEV_FLAGS_INPUT
;
290 sdev
.putc
= serial_stub_putc
;
291 sdev
.puts
= serial_stub_puts
;
292 sdev
.getc
= serial_stub_getc
;
293 sdev
.tstc
= serial_stub_tstc
;
294 stdio_register_dev(&sdev
, &upriv
->sdev
);
299 static int serial_pre_remove(struct udevice
*dev
)
301 #ifdef CONFIG_SYS_STDIO_DEREGISTER
302 struct serial_dev_priv
*upriv
= dev_get_uclass_priv(dev
);
304 if (stdio_deregister_dev(upriv
->sdev
, 0))
311 UCLASS_DRIVER(serial
) = {
314 .flags
= DM_UC_FLAG_SEQ_ALIAS
,
315 .post_probe
= serial_post_probe
,
316 .pre_remove
= serial_pre_remove
,
317 .per_device_auto_alloc_size
= sizeof(struct serial_dev_priv
),