stdio.c 6.87 KB
Newer Older
wdenk's avatar
wdenk committed
1
/*
2 3 4 5
 * Copyright (C) 2009 Sergey Kubushyn <ksi@koi8.net>
 *
 * Changes for multibus/multiadapter I2C support.
 *
wdenk's avatar
wdenk committed
6 7 8
 * (C) Copyright 2000
 * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
 *
9
 * SPDX-License-Identifier:	GPL-2.0+
wdenk's avatar
wdenk committed
10 11 12 13
 */

#include <config.h>
#include <common.h>
14
#include <dm.h>
15
#include <errno.h>
wdenk's avatar
wdenk committed
16 17
#include <stdarg.h>
#include <malloc.h>
18
#include <stdio_dev.h>
wdenk's avatar
wdenk committed
19
#include <serial.h>
wdenk's avatar
wdenk committed
20 21 22
#ifdef CONFIG_LOGBUFFER
#include <logbuff.h>
#endif
23 24

#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
wdenk's avatar
wdenk committed
25
#include <i2c.h>
wdenk's avatar
wdenk committed
26
#endif
wdenk's avatar
wdenk committed
27

28 29
#include <dm/device-internal.h>

30 31
DECLARE_GLOBAL_DATA_PTR;

32 33
static struct stdio_dev devs;
struct stdio_dev *stdio_devices[] = { NULL, NULL, NULL };
wdenk's avatar
wdenk committed
34 35
char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };

36 37
#if defined(CONFIG_SPLASH_SCREEN) && !defined(CONFIG_SYS_DEVICE_NULLDEV)
#define	CONFIG_SYS_DEVICE_NULLDEV	1
38 39
#endif

40 41 42
#ifdef	CONFIG_SYS_STDIO_DEREGISTER
#define	CONFIG_SYS_DEVICE_NULLDEV	1
#endif
43

44
#ifdef CONFIG_SYS_DEVICE_NULLDEV
45
static void nulldev_putc(struct stdio_dev *dev, const char c)
wdenk's avatar
wdenk committed
46
{
47
	/* nulldev is empty! */
wdenk's avatar
wdenk committed
48 49
}

50
static void nulldev_puts(struct stdio_dev *dev, const char *s)
wdenk's avatar
wdenk committed
51
{
52
	/* nulldev is empty! */
wdenk's avatar
wdenk committed
53 54
}

55
static int nulldev_input(struct stdio_dev *dev)
wdenk's avatar
wdenk committed
56
{
57 58
	/* nulldev is empty! */
	return 0;
wdenk's avatar
wdenk committed
59 60 61
}
#endif

62
static void stdio_serial_putc(struct stdio_dev *dev, const char c)
63 64 65 66
{
	serial_putc(c);
}

67
static void stdio_serial_puts(struct stdio_dev *dev, const char *s)
68 69 70 71
{
	serial_puts(s);
}

72
static int stdio_serial_getc(struct stdio_dev *dev)
73 74 75 76
{
	return serial_getc();
}

77
static int stdio_serial_tstc(struct stdio_dev *dev)
78 79 80 81
{
	return serial_tstc();
}

wdenk's avatar
wdenk committed
82 83 84 85 86 87 88
/**************************************************************************
 * SYSTEM DRIVERS
 **************************************************************************
 */

static void drv_system_init (void)
{
89
	struct stdio_dev dev;
wdenk's avatar
wdenk committed
90 91 92 93

	memset (&dev, 0, sizeof (dev));

	strcpy (dev.name, "serial");
94
	dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
95 96 97 98
	dev.putc = stdio_serial_putc;
	dev.puts = stdio_serial_puts;
	dev.getc = stdio_serial_getc;
	dev.tstc = stdio_serial_tstc;
99
	stdio_register (&dev);
wdenk's avatar
wdenk committed
100

101
#ifdef CONFIG_SYS_DEVICE_NULLDEV
wdenk's avatar
wdenk committed
102 103 104
	memset (&dev, 0, sizeof (dev));

	strcpy (dev.name, "nulldev");
105
	dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT;
wdenk's avatar
wdenk committed
106 107 108 109 110
	dev.putc = nulldev_putc;
	dev.puts = nulldev_puts;
	dev.getc = nulldev_input;
	dev.tstc = nulldev_input;

111
	stdio_register (&dev);
wdenk's avatar
wdenk committed
112 113 114 115 116 117 118
#endif
}

/**************************************************************************
 * DEVICES
 **************************************************************************
 */
119
struct list_head* stdio_get_list(void)
120 121 122 123
{
	return &(devs.list);
}

124
struct stdio_dev* stdio_get_by_name(const char *name)
125 126
{
	struct list_head *pos;
127
	struct stdio_dev *dev;
128 129 130 131 132

	if(!name)
		return NULL;

	list_for_each(pos, &(devs.list)) {
133
		dev = list_entry(pos, struct stdio_dev, list);
134 135 136 137 138 139 140
		if(strcmp(dev->name, name) == 0)
			return dev;
	}

	return NULL;
}

141
struct stdio_dev* stdio_clone(struct stdio_dev *dev)
142
{
143
	struct stdio_dev *_dev;
144 145 146 147

	if(!dev)
		return NULL;

148
	_dev = calloc(1, sizeof(struct stdio_dev));
149 150 151 152

	if(!_dev)
		return NULL;

153
	memcpy(_dev, dev, sizeof(struct stdio_dev));
154 155 156

	return _dev;
}
wdenk's avatar
wdenk committed
157

158
int stdio_register_dev(struct stdio_dev *dev, struct stdio_dev **devp)
wdenk's avatar
wdenk committed
159
{
160
	struct stdio_dev *_dev;
161

162
	_dev = stdio_clone(dev);
163
	if(!_dev)
164
		return -ENODEV;
165
	list_add_tail(&(_dev->list), &(devs.list));
166 167 168
	if (devp)
		*devp = _dev;

wdenk's avatar
wdenk committed
169 170 171
	return 0;
}

172 173 174 175 176
int stdio_register(struct stdio_dev *dev)
{
	return stdio_register_dev(dev, NULL);
}

wdenk's avatar
wdenk committed
177 178 179
/* deregister the device "devname".
 * returns 0 if success, -1 if device is assigned and 1 if devname not found
 */
180
#ifdef	CONFIG_SYS_STDIO_DEREGISTER
181
int stdio_deregister_dev(struct stdio_dev *dev, int force)
wdenk's avatar
wdenk committed
182
{
183 184
	int l;
	struct list_head *pos;
185
	char temp_names[3][16];
wdenk's avatar
wdenk committed
186 187 188 189

	/* get stdio devices (ListRemoveItem changes the dev list) */
	for (l=0 ; l< MAX_FILES; l++) {
		if (stdio_devices[l] == dev) {
190 191 192 193
			if (force) {
				strcpy(temp_names[l], "nulldev");
				continue;
			}
wdenk's avatar
wdenk committed
194 195 196 197 198
			/* Device is assigned -> report error */
			return -1;
		}
		memcpy (&temp_names[l][0],
			stdio_devices[l]->name,
199
			sizeof(temp_names[l]));
wdenk's avatar
wdenk committed
200
	}
201 202

	list_del(&(dev->list));
203
	free(dev);
204

wdenk's avatar
wdenk committed
205
	/* reassign Device list */
206
	list_for_each(pos, &(devs.list)) {
207
		dev = list_entry(pos, struct stdio_dev, list);
wdenk's avatar
wdenk committed
208
		for (l=0 ; l< MAX_FILES; l++) {
209
			if(strcmp(dev->name, temp_names[l]) == 0)
wdenk's avatar
wdenk committed
210 211 212 213 214
				stdio_devices[l] = dev;
		}
	}
	return 0;
}
215

216
int stdio_deregister(const char *devname, int force)
217 218 219 220 221 222 223 224
{
	struct stdio_dev *dev;

	dev = stdio_get_by_name(devname);

	if (!dev) /* device not found */
		return -ENODEV;

225
	return stdio_deregister_dev(dev, force);
226
}
227
#endif	/* CONFIG_SYS_STDIO_DEREGISTER */
wdenk's avatar
wdenk committed
228

229
int stdio_init_tables(void)
wdenk's avatar
wdenk committed
230
{
231
#if defined(CONFIG_NEEDS_MANUAL_RELOC)
232
	/* already relocated for current ARM implementation */
wdenk's avatar
wdenk committed
233
	ulong relocation_offset = gd->reloc_off;
234
	int i;
wdenk's avatar
wdenk committed
235 236 237 238 239 240

	/* relocate device name pointers */
	for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
		stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
						relocation_offset);
	}
241
#endif /* CONFIG_NEEDS_MANUAL_RELOC */
wdenk's avatar
wdenk committed
242 243

	/* Initialize the list */
244
	INIT_LIST_HEAD(&(devs.list));
wdenk's avatar
wdenk committed
245

246 247 248 249 250
	return 0;
}

int stdio_add_devices(void)
{
251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276
#ifdef CONFIG_DM_KEYBOARD
	struct udevice *dev;
	struct uclass *uc;
	int ret;

	/*
	 * For now we probe all the devices here. At some point this should be
	 * done only when the devices are required - e.g. we have a list of
	 * input devices to start up in the stdin environment variable. That
	 * work probably makes more sense when stdio itself is converted to
	 * driver model.
	 *
	 * TODO(sjg@chromium.org): Convert changing uclass_first_device() etc.
	 * to return the device even on error. Then we could use that here.
	 */
	ret = uclass_get(UCLASS_KEYBOARD, &uc);
	if (ret)
		return ret;

	/* Don't report errors to the caller - assume that they are non-fatal */
	uclass_foreach_dev(dev, uc) {
		ret = device_probe(dev);
		if (ret)
			printf("Failed to probe keyboard '%s'\n", dev->name);
	}
#endif
277 278 279
#ifdef CONFIG_SYS_I2C
	i2c_init_all();
#else
280
#if defined(CONFIG_HARD_I2C)
281
	i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
wdenk's avatar
wdenk committed
282
#endif
283
#endif
284 285
#ifdef CONFIG_DM_VIDEO
	struct udevice *vdev;
286 287 288
# ifndef CONFIG_DM_KEYBOARD
	int ret;
# endif
289 290 291 292 293 294 295 296 297

	for (ret = uclass_first_device(UCLASS_VIDEO, &vdev);
	     vdev;
	     ret = uclass_next_device(&vdev))
		;
	if (ret)
		printf("%s: Video device failed (ret=%d)\n", __func__, ret);
#else
# if defined(CONFIG_LCD)
wdenk's avatar
wdenk committed
298
	drv_lcd_init ();
299 300
# endif
# if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
wdenk's avatar
wdenk committed
301
	drv_video_init ();
302 303
# endif
#endif /* CONFIG_DM_VIDEO */
304
#if defined(CONFIG_KEYBOARD) && !defined(CONFIG_DM_KEYBOARD)
305
	drv_keyboard_init ();
306 307 308
#endif
#ifdef CONFIG_LOGBUFFER
	drv_logbuff_init ();
wdenk's avatar
wdenk committed
309 310
#endif
	drv_system_init ();
311
	serial_stdio_init ();
312 313 314
#ifdef CONFIG_USB_TTY
	drv_usbtty_init ();
#endif
315 316 317
#ifdef CONFIG_NETCONSOLE
	drv_nc_init ();
#endif
318 319 320
#ifdef CONFIG_JTAG_CONSOLE
	drv_jtag_console_init ();
#endif
321 322 323
#ifdef CONFIG_CBMEM_CONSOLE
	cbmemc_init();
#endif
324 325 326 327 328 329 330 331 332 333

	return 0;
}

int stdio_init(void)
{
	stdio_init_tables();
	stdio_add_devices();

	return 0;
wdenk's avatar
wdenk committed
334
}