2 * Copyright (c) 2014 The Chromium OS Authors.
4 * SPDX-License-Identifier: GPL-2.0+
13 #include <stdio_dev.h>
16 #include <dm/device-internal.h>
20 DECLARE_GLOBAL_DATA_PTR;
22 #ifndef CONFIG_SYS_MALLOC_F_LEN
23 #error "Serial is required before relocation - define CONFIG_SYS_MALLOC_F_LEN to make this work"
26 static void serial_find_console_or_panic(void)
30 #ifdef CONFIG_OF_CONTROL
33 /* Check for a chosen console */
34 node = fdtdec_get_chosen_node(gd->fdt_blob, "stdout-path");
36 node = fdtdec_get_alias_node(gd->fdt_blob, "console");
37 if (!uclass_get_device_by_of_offset(UCLASS_SERIAL, node, &dev)) {
38 gd->cur_serial_dev = dev;
43 * If the console is not marked to be bound before relocation, bind
47 !lists_bind_fdt(gd->dm_root, gd->fdt_blob, node, &dev)) {
48 if (!device_probe(dev)) {
49 gd->cur_serial_dev = dev;
55 * Try to use CONFIG_CONS_INDEX if available (it is numbered from 1!).
57 * Failing that, get the device with sequence number 0, or in extremis
58 * just the first serial device we can find. But we insist on having
59 * a console (even if it is silent).
61 #ifdef CONFIG_CONS_INDEX
62 #define INDEX (CONFIG_CONS_INDEX - 1)
66 if (uclass_get_device_by_seq(UCLASS_SERIAL, INDEX, &dev) &&
67 uclass_get_device(UCLASS_SERIAL, INDEX, &dev) &&
68 (uclass_first_device(UCLASS_SERIAL, &dev) || !dev))
69 panic("No serial driver found");
71 gd->cur_serial_dev = dev;
74 /* Called prior to relocation */
77 serial_find_console_or_panic();
78 gd->flags |= GD_FLG_SERIAL_READY;
83 /* Called after relocation */
84 void serial_initialize(void)
86 serial_find_console_or_panic();
89 static void _serial_putc(struct udevice *dev, char ch)
91 struct dm_serial_ops *ops = serial_get_ops(dev);
95 err = ops->putc(dev, ch);
96 } while (err == -EAGAIN);
98 _serial_putc(dev, '\r');
101 static void _serial_puts(struct udevice *dev, const char *str)
104 _serial_putc(dev, *str++);
107 static int _serial_getc(struct udevice *dev)
109 struct dm_serial_ops *ops = serial_get_ops(dev);
113 err = ops->getc(dev);
116 } while (err == -EAGAIN);
118 return err >= 0 ? err : 0;
121 static int _serial_tstc(struct udevice *dev)
123 struct dm_serial_ops *ops = serial_get_ops(dev);
126 return ops->pending(dev, true);
131 void serial_putc(char ch)
133 _serial_putc(gd->cur_serial_dev, ch);
136 void serial_puts(const char *str)
138 _serial_puts(gd->cur_serial_dev, str);
141 int serial_getc(void)
143 return _serial_getc(gd->cur_serial_dev);
146 int serial_tstc(void)
148 return _serial_tstc(gd->cur_serial_dev);
151 void serial_setbrg(void)
153 struct dm_serial_ops *ops = serial_get_ops(gd->cur_serial_dev);
156 ops->setbrg(gd->cur_serial_dev, gd->baudrate);
159 void serial_stdio_init(void)
163 static void serial_stub_putc(struct stdio_dev *sdev, const char ch)
165 _serial_putc(sdev->priv, ch);
168 void serial_stub_puts(struct stdio_dev *sdev, const char *str)
170 _serial_puts(sdev->priv, str);
173 int serial_stub_getc(struct stdio_dev *sdev)
175 return _serial_getc(sdev->priv);
178 int serial_stub_tstc(struct stdio_dev *sdev)
180 return _serial_tstc(sdev->priv);
183 static int serial_post_probe(struct udevice *dev)
185 struct stdio_dev sdev;
186 struct dm_serial_ops *ops = serial_get_ops(dev);
187 struct serial_dev_priv *upriv = dev->uclass_priv;
190 /* Set the baud rate */
192 ret = ops->setbrg(dev, gd->baudrate);
197 if (!(gd->flags & GD_FLG_RELOC))
200 memset(&sdev, '\0', sizeof(sdev));
202 strncpy(sdev.name, dev->name, sizeof(sdev.name));
203 sdev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
205 sdev.putc = serial_stub_putc;
206 sdev.puts = serial_stub_puts;
207 sdev.getc = serial_stub_getc;
208 sdev.tstc = serial_stub_tstc;
209 stdio_register_dev(&sdev, &upriv->sdev);
214 static int serial_pre_remove(struct udevice *dev)
216 #ifdef CONFIG_SYS_STDIO_DEREGISTER
217 struct serial_dev_priv *upriv = dev->uclass_priv;
219 if (stdio_deregister_dev(upriv->sdev, 0))
226 UCLASS_DRIVER(serial) = {
229 .post_probe = serial_post_probe,
230 .pre_remove = serial_pre_remove,
231 .per_device_auto_alloc_size = sizeof(struct serial_dev_priv),