blob: 8e4a9beef4542dab055489c31589a0f4c64b3707 [file] [log] [blame]
wdenk91d32562002-09-18 21:21:13 +00001/*
Heiko Schocher3f4978c2012-01-16 21:12:24 +00002 * Copyright (C) 2009 Sergey Kubushyn <ksi@koi8.net>
3 *
4 * Changes for multibus/multiadapter I2C support.
5 *
wdenk91d32562002-09-18 21:21:13 +00006 * (C) Copyright 2000
7 * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
8 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02009 * SPDX-License-Identifier: GPL-2.0+
wdenk91d32562002-09-18 21:21:13 +000010 */
11
12#include <config.h>
13#include <common.h>
Simon Glassb206cd72015-10-18 21:17:15 -060014#include <dm.h>
Simon Glassd97143a2014-07-23 06:55:05 -060015#include <errno.h>
wdenk91d32562002-09-18 21:21:13 +000016#include <stdarg.h>
17#include <malloc.h>
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020018#include <stdio_dev.h>
wdenk281e00a2004-08-01 22:48:16 +000019#include <serial.h>
wdenk7f6c2cb2002-11-10 22:06:23 +000020#ifdef CONFIG_LOGBUFFER
21#include <logbuff.h>
22#endif
Heiko Schocherea818db2013-01-29 08:53:15 +010023
24#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
wdenk91d32562002-09-18 21:21:13 +000025#include <i2c.h>
wdenk7f6c2cb2002-11-10 22:06:23 +000026#endif
wdenk91d32562002-09-18 21:21:13 +000027
Simon Glassb206cd72015-10-18 21:17:15 -060028#include <dm/device-internal.h>
29
Wolfgang Denkd87080b2006-03-31 18:32:53 +020030DECLARE_GLOBAL_DATA_PTR;
31
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020032static struct stdio_dev devs;
33struct stdio_dev *stdio_devices[] = { NULL, NULL, NULL };
wdenk91d32562002-09-18 21:21:13 +000034char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };
35
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020036#if defined(CONFIG_SPLASH_SCREEN) && !defined(CONFIG_SYS_DEVICE_NULLDEV)
37#define CONFIG_SYS_DEVICE_NULLDEV 1
wdenkd791b1d2003-04-20 14:04:18 +000038#endif
39
Simon Glass869588d2016-10-17 20:13:02 -060040#if CONFIG_IS_ENABLED(SYS_STDIO_DEREGISTER)
Hans de Goede32d01922014-09-20 16:54:37 +020041#define CONFIG_SYS_DEVICE_NULLDEV 1
42#endif
wdenkd791b1d2003-04-20 14:04:18 +000043
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020044#ifdef CONFIG_SYS_DEVICE_NULLDEV
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020045static void nulldev_putc(struct stdio_dev *dev, const char c)
wdenk91d32562002-09-18 21:21:13 +000046{
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +020047 /* nulldev is empty! */
wdenk91d32562002-09-18 21:21:13 +000048}
49
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020050static void nulldev_puts(struct stdio_dev *dev, const char *s)
wdenk91d32562002-09-18 21:21:13 +000051{
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +020052 /* nulldev is empty! */
wdenk91d32562002-09-18 21:21:13 +000053}
54
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020055static int nulldev_input(struct stdio_dev *dev)
wdenk91d32562002-09-18 21:21:13 +000056{
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +020057 /* nulldev is empty! */
58 return 0;
wdenk91d32562002-09-18 21:21:13 +000059}
60#endif
61
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020062static void stdio_serial_putc(struct stdio_dev *dev, const char c)
Simon Glass709ea542014-07-23 06:54:59 -060063{
64 serial_putc(c);
65}
66
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020067static void stdio_serial_puts(struct stdio_dev *dev, const char *s)
Simon Glass709ea542014-07-23 06:54:59 -060068{
69 serial_puts(s);
70}
71
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020072static int stdio_serial_getc(struct stdio_dev *dev)
Simon Glass709ea542014-07-23 06:54:59 -060073{
74 return serial_getc();
75}
76
Jeroen Hofstee654f8d02014-10-08 22:57:44 +020077static int stdio_serial_tstc(struct stdio_dev *dev)
Simon Glass709ea542014-07-23 06:54:59 -060078{
79 return serial_tstc();
80}
81
wdenk91d32562002-09-18 21:21:13 +000082/**************************************************************************
83 * SYSTEM DRIVERS
84 **************************************************************************
85 */
86
87static void drv_system_init (void)
88{
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020089 struct stdio_dev dev;
wdenk91d32562002-09-18 21:21:13 +000090
91 memset (&dev, 0, sizeof (dev));
92
93 strcpy (dev.name, "serial");
Bin Meng1caf9342015-11-03 23:23:37 -080094 dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
Simon Glass709ea542014-07-23 06:54:59 -060095 dev.putc = stdio_serial_putc;
96 dev.puts = stdio_serial_puts;
97 dev.getc = stdio_serial_getc;
98 dev.tstc = stdio_serial_tstc;
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020099 stdio_register (&dev);
wdenk91d32562002-09-18 21:21:13 +0000100
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200101#ifdef CONFIG_SYS_DEVICE_NULLDEV
wdenk91d32562002-09-18 21:21:13 +0000102 memset (&dev, 0, sizeof (dev));
103
104 strcpy (dev.name, "nulldev");
Bin Meng1caf9342015-11-03 23:23:37 -0800105 dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
wdenk91d32562002-09-18 21:21:13 +0000106 dev.putc = nulldev_putc;
107 dev.puts = nulldev_puts;
108 dev.getc = nulldev_input;
109 dev.tstc = nulldev_input;
110
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200111 stdio_register (&dev);
wdenk91d32562002-09-18 21:21:13 +0000112#endif
113}
114
115/**************************************************************************
116 * DEVICES
117 **************************************************************************
118 */
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200119struct list_head* stdio_get_list(void)
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200120{
121 return &(devs.list);
122}
123
Simon Glassd8441ea2016-10-05 20:42:16 -0600124#ifdef CONFIG_DM_VIDEO
125/**
126 * stdio_probe_device() - Find a device which provides the given stdio device
127 *
128 * This looks for a device of the given uclass which provides a particular
129 * stdio device. It is currently really only useful for UCLASS_VIDEO.
130 *
131 * Ultimately we want to be able to probe a device by its stdio name. At
132 * present devices register in their probe function (for video devices this
133 * is done in vidconsole_post_probe()) and we don't know what name they will
134 * use until they do so.
135 * TODO(sjg@chromium.org): We should be able to determine the name before
136 * probing, and probe the required device.
137 *
138 * @name: stdio device name (e.g. "vidconsole")
139 * id: Uclass ID of device to look for (e.g. UCLASS_VIDEO)
140 * @sdevp: Returns stdout device, if found, else NULL
141 * @return 0 if found, -ENOENT if no device found with that name, other -ve
142 * on other error
143 */
144static int stdio_probe_device(const char *name, enum uclass_id id,
145 struct stdio_dev **sdevp)
146{
147 struct stdio_dev *sdev;
148 struct udevice *dev;
149 int seq, ret;
150
151 *sdevp = NULL;
152 seq = trailing_strtoln(name, NULL);
153 if (seq == -1)
154 ret = uclass_first_device_err(id, &dev);
155 else
156 ret = uclass_get_device_by_seq(id, seq, &dev);
157 if (ret) {
158 debug("No %s device for seq %d (%s)\n", uclass_get_name(id),
159 seq, name);
160 return ret;
161 }
162 /* The device should be be the last one registered */
163 sdev = list_empty(&devs.list) ? NULL :
164 list_last_entry(&devs.list, struct stdio_dev, list);
165 if (!sdev || strcmp(sdev->name, name)) {
166 debug("Device '%s' did not register with stdio as '%s'\n",
167 dev->name, name);
168 return -ENOENT;
169 }
170 *sdevp = sdev;
171
172 return 0;
173}
174#endif
175
Mike Frysingerd7be3052010-10-20 07:18:03 -0400176struct stdio_dev* stdio_get_by_name(const char *name)
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200177{
178 struct list_head *pos;
Simon Glassd8441ea2016-10-05 20:42:16 -0600179 struct stdio_dev *sdev;
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200180
181 if(!name)
182 return NULL;
183
184 list_for_each(pos, &(devs.list)) {
Simon Glassd8441ea2016-10-05 20:42:16 -0600185 sdev = list_entry(pos, struct stdio_dev, list);
186 if (strcmp(sdev->name, name) == 0)
187 return sdev;
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200188 }
Simon Glassd8441ea2016-10-05 20:42:16 -0600189#ifdef CONFIG_DM_VIDEO
190 /*
191 * We did not find a suitable stdio device. If there is a video
192 * driver with a name starting with 'vidconsole', we can try probing
193 * that in the hope that it will produce the required stdio device.
194 *
195 * This function is sometimes called with the entire value of
196 * 'stdout', which may include a list of devices separate by commas.
197 * Obviously this is not going to work, so we ignore that case. The
198 * call path in that case is console_init_r() -> search_device() ->
199 * stdio_get_by_name().
200 */
201 if (!strncmp(name, "vidconsole", 10) && !strchr(name, ',') &&
202 !stdio_probe_device(name, UCLASS_VIDEO, &sdev))
203 return sdev;
204#endif
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200205
206 return NULL;
207}
208
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200209struct stdio_dev* stdio_clone(struct stdio_dev *dev)
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200210{
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200211 struct stdio_dev *_dev;
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200212
213 if(!dev)
214 return NULL;
215
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200216 _dev = calloc(1, sizeof(struct stdio_dev));
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200217
218 if(!_dev)
219 return NULL;
220
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200221 memcpy(_dev, dev, sizeof(struct stdio_dev));
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200222
223 return _dev;
224}
wdenk91d32562002-09-18 21:21:13 +0000225
Simon Glassd97143a2014-07-23 06:55:05 -0600226int stdio_register_dev(struct stdio_dev *dev, struct stdio_dev **devp)
wdenk91d32562002-09-18 21:21:13 +0000227{
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200228 struct stdio_dev *_dev;
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200229
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200230 _dev = stdio_clone(dev);
Jean-Christophe PLAGNIOL-VILLARD628ffd72008-09-01 17:11:26 +0200231 if(!_dev)
Simon Glassd97143a2014-07-23 06:55:05 -0600232 return -ENODEV;
Stefan Roese3e3c0262008-09-05 10:47:46 +0200233 list_add_tail(&(_dev->list), &(devs.list));
Simon Glassd97143a2014-07-23 06:55:05 -0600234 if (devp)
235 *devp = _dev;
236
wdenk91d32562002-09-18 21:21:13 +0000237 return 0;
238}
239
Simon Glassd97143a2014-07-23 06:55:05 -0600240int stdio_register(struct stdio_dev *dev)
241{
242 return stdio_register_dev(dev, NULL);
243}
244
wdenk91d32562002-09-18 21:21:13 +0000245/* deregister the device "devname".
246 * returns 0 if success, -1 if device is assigned and 1 if devname not found
247 */
Simon Glass869588d2016-10-17 20:13:02 -0600248#if CONFIG_IS_ENABLED(SYS_STDIO_DEREGISTER)
Hans de Goede32d01922014-09-20 16:54:37 +0200249int stdio_deregister_dev(struct stdio_dev *dev, int force)
wdenk91d32562002-09-18 21:21:13 +0000250{
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200251 int l;
252 struct list_head *pos;
Bradley Bolen03bf22f2011-08-22 11:48:05 +0000253 char temp_names[3][16];
wdenk91d32562002-09-18 21:21:13 +0000254
wdenk91d32562002-09-18 21:21:13 +0000255 /* get stdio devices (ListRemoveItem changes the dev list) */
256 for (l=0 ; l< MAX_FILES; l++) {
257 if (stdio_devices[l] == dev) {
Hans de Goede32d01922014-09-20 16:54:37 +0200258 if (force) {
259 strcpy(temp_names[l], "nulldev");
260 continue;
261 }
wdenk91d32562002-09-18 21:21:13 +0000262 /* Device is assigned -> report error */
263 return -1;
264 }
265 memcpy (&temp_names[l][0],
266 stdio_devices[l]->name,
Bradley Bolen03bf22f2011-08-22 11:48:05 +0000267 sizeof(temp_names[l]));
wdenk91d32562002-09-18 21:21:13 +0000268 }
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200269
270 list_del(&(dev->list));
Hans de Goede88274b62014-09-24 14:06:09 +0200271 free(dev);
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200272
wdenk91d32562002-09-18 21:21:13 +0000273 /* reassign Device list */
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200274 list_for_each(pos, &(devs.list)) {
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200275 dev = list_entry(pos, struct stdio_dev, list);
wdenk91d32562002-09-18 21:21:13 +0000276 for (l=0 ; l< MAX_FILES; l++) {
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200277 if(strcmp(dev->name, temp_names[l]) == 0)
wdenk91d32562002-09-18 21:21:13 +0000278 stdio_devices[l] = dev;
wdenk91d32562002-09-18 21:21:13 +0000279 }
280 }
281 return 0;
282}
Simon Glassd97143a2014-07-23 06:55:05 -0600283
Hans de Goede32d01922014-09-20 16:54:37 +0200284int stdio_deregister(const char *devname, int force)
Simon Glassd97143a2014-07-23 06:55:05 -0600285{
286 struct stdio_dev *dev;
287
288 dev = stdio_get_by_name(devname);
289
290 if (!dev) /* device not found */
291 return -ENODEV;
292
Hans de Goede32d01922014-09-20 16:54:37 +0200293 return stdio_deregister_dev(dev, force);
Simon Glassd97143a2014-07-23 06:55:05 -0600294}
Simon Glass869588d2016-10-17 20:13:02 -0600295#endif /* CONFIG_IS_ENABLED(SYS_STDIO_DEREGISTER) */
wdenk91d32562002-09-18 21:21:13 +0000296
Simon Glass9fb02492014-09-03 17:37:01 -0600297int stdio_init_tables(void)
wdenk91d32562002-09-18 21:21:13 +0000298{
Wolfgang Denk2e5167c2010-10-28 20:00:11 +0200299#if defined(CONFIG_NEEDS_MANUAL_RELOC)
Peter Tyser521af042009-09-21 11:20:36 -0500300 /* already relocated for current ARM implementation */
wdenk91d32562002-09-18 21:21:13 +0000301 ulong relocation_offset = gd->reloc_off;
wdenk3595ac42003-06-22 17:18:28 +0000302 int i;
wdenk91d32562002-09-18 21:21:13 +0000303
304 /* relocate device name pointers */
305 for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
306 stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
307 relocation_offset);
308 }
Wolfgang Denk2e5167c2010-10-28 20:00:11 +0200309#endif /* CONFIG_NEEDS_MANUAL_RELOC */
wdenk91d32562002-09-18 21:21:13 +0000310
311 /* Initialize the list */
Jean-Christophe PLAGNIOL-VILLARDc1de7a62008-08-31 04:24:55 +0200312 INIT_LIST_HEAD(&(devs.list));
wdenk91d32562002-09-18 21:21:13 +0000313
Simon Glass9fb02492014-09-03 17:37:01 -0600314 return 0;
315}
316
317int stdio_add_devices(void)
318{
Simon Glassb206cd72015-10-18 21:17:15 -0600319#ifdef CONFIG_DM_KEYBOARD
320 struct udevice *dev;
321 struct uclass *uc;
322 int ret;
323
324 /*
325 * For now we probe all the devices here. At some point this should be
326 * done only when the devices are required - e.g. we have a list of
327 * input devices to start up in the stdin environment variable. That
328 * work probably makes more sense when stdio itself is converted to
329 * driver model.
330 *
331 * TODO(sjg@chromium.org): Convert changing uclass_first_device() etc.
332 * to return the device even on error. Then we could use that here.
333 */
334 ret = uclass_get(UCLASS_KEYBOARD, &uc);
335 if (ret)
336 return ret;
337
338 /* Don't report errors to the caller - assume that they are non-fatal */
339 uclass_foreach_dev(dev, uc) {
340 ret = device_probe(dev);
341 if (ret)
342 printf("Failed to probe keyboard '%s'\n", dev->name);
343 }
344#endif
Heiko Schocher3f4978c2012-01-16 21:12:24 +0000345#ifdef CONFIG_SYS_I2C
Heiko Schocher3f4978c2012-01-16 21:12:24 +0000346 i2c_init_all();
Heiko Schocher3f4978c2012-01-16 21:12:24 +0000347#else
Heiko Schocherea818db2013-01-29 08:53:15 +0100348#if defined(CONFIG_HARD_I2C)
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200349 i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
wdenk91d32562002-09-18 21:21:13 +0000350#endif
Heiko Schocher3f4978c2012-01-16 21:12:24 +0000351#endif
Simon Glasse3b81c12016-01-18 19:52:23 -0700352#ifdef CONFIG_DM_VIDEO
Simon Glassd8441ea2016-10-05 20:42:16 -0600353 /*
354 * If the console setting is not in environment variables then
355 * console_init_r() will not be calling iomux_doenv() (which calls
356 * search_device()). So we will not dynamically add devices by
357 * calling stdio_probe_device().
358 *
359 * So just probe all video devices now so that whichever one is
360 * required will be available.
361 */
362#ifndef CONFIG_SYS_CONSOLE_IS_IN_ENV
Simon Glasse3b81c12016-01-18 19:52:23 -0700363 struct udevice *vdev;
Simon Glass35a1f0d2016-01-21 19:44:49 -0700364# ifndef CONFIG_DM_KEYBOARD
365 int ret;
366# endif
Simon Glasse3b81c12016-01-18 19:52:23 -0700367
368 for (ret = uclass_first_device(UCLASS_VIDEO, &vdev);
369 vdev;
370 ret = uclass_next_device(&vdev))
371 ;
372 if (ret)
373 printf("%s: Video device failed (ret=%d)\n", __func__, ret);
Simon Glassd8441ea2016-10-05 20:42:16 -0600374#endif /* !CONFIG_SYS_CONSOLE_IS_IN_ENV */
Simon Glasse3b81c12016-01-18 19:52:23 -0700375#else
376# if defined(CONFIG_LCD)
wdenk91d32562002-09-18 21:21:13 +0000377 drv_lcd_init ();
Simon Glasse3b81c12016-01-18 19:52:23 -0700378# endif
379# if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
wdenk91d32562002-09-18 21:21:13 +0000380 drv_video_init ();
Simon Glasse3b81c12016-01-18 19:52:23 -0700381# endif
382#endif /* CONFIG_DM_VIDEO */
Simon Glassb206cd72015-10-18 21:17:15 -0600383#if defined(CONFIG_KEYBOARD) && !defined(CONFIG_DM_KEYBOARD)
wdenk682011f2003-06-03 23:54:09 +0000384 drv_keyboard_init ();
wdenk91d32562002-09-18 21:21:13 +0000385#endif
wdenk56f94be2002-11-05 16:35:14 +0000386#ifdef CONFIG_LOGBUFFER
387 drv_logbuff_init ();
388#endif
wdenk91d32562002-09-18 21:21:13 +0000389 drv_system_init ();
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200390 serial_stdio_init ();
wdenk232c1502004-03-12 00:14:09 +0000391#ifdef CONFIG_USB_TTY
392 drv_usbtty_init ();
393#endif
wdenk68ceb292004-08-02 21:11:11 +0000394#ifdef CONFIG_NETCONSOLE
395 drv_nc_init ();
396#endif
Mike Frysinger36ea8e92008-10-11 21:51:20 -0400397#ifdef CONFIG_JTAG_CONSOLE
398 drv_jtag_console_init ();
399#endif
Vadim Bendebury98ab4352012-10-12 18:48:47 +0000400#ifdef CONFIG_CBMEM_CONSOLE
401 cbmemc_init();
402#endif
Simon Glass9fb02492014-09-03 17:37:01 -0600403
404 return 0;
405}
406
407int stdio_init(void)
408{
409 stdio_init_tables();
410 stdio_add_devices();
411
412 return 0;
wdenk91d32562002-09-18 21:21:13 +0000413}