For some boards board_init() will change GPIOs, so we need to have driver model available before then. Adjust the board init to arrange this, but enable it for driver model only, just to be safe. This does create additional #ifdef logic, but it is safer than trying to make a pervasive change which may cause some boards to break. Signed-off-by: Simon Glass <sjg@chromium.org>
284 lines
5.5 KiB
C
284 lines
5.5 KiB
C
/*
|
|
* Copyright (C) 2009 Sergey Kubushyn <ksi@koi8.net>
|
|
*
|
|
* Changes for multibus/multiadapter I2C support.
|
|
*
|
|
* (C) Copyright 2000
|
|
* Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <errno.h>
|
|
#include <stdarg.h>
|
|
#include <malloc.h>
|
|
#include <stdio_dev.h>
|
|
#include <serial.h>
|
|
#ifdef CONFIG_LOGBUFFER
|
|
#include <logbuff.h>
|
|
#endif
|
|
|
|
#if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
|
|
#include <i2c.h>
|
|
#endif
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
static struct stdio_dev devs;
|
|
struct stdio_dev *stdio_devices[] = { NULL, NULL, NULL };
|
|
char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };
|
|
|
|
#if defined(CONFIG_SPLASH_SCREEN) && !defined(CONFIG_SYS_DEVICE_NULLDEV)
|
|
#define CONFIG_SYS_DEVICE_NULLDEV 1
|
|
#endif
|
|
|
|
|
|
#ifdef CONFIG_SYS_DEVICE_NULLDEV
|
|
void nulldev_putc(struct stdio_dev *dev, const char c)
|
|
{
|
|
/* nulldev is empty! */
|
|
}
|
|
|
|
void nulldev_puts(struct stdio_dev *dev, const char *s)
|
|
{
|
|
/* nulldev is empty! */
|
|
}
|
|
|
|
int nulldev_input(struct stdio_dev *dev)
|
|
{
|
|
/* nulldev is empty! */
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
void stdio_serial_putc(struct stdio_dev *dev, const char c)
|
|
{
|
|
serial_putc(c);
|
|
}
|
|
|
|
void stdio_serial_puts(struct stdio_dev *dev, const char *s)
|
|
{
|
|
serial_puts(s);
|
|
}
|
|
|
|
int stdio_serial_getc(struct stdio_dev *dev)
|
|
{
|
|
return serial_getc();
|
|
}
|
|
|
|
int stdio_serial_tstc(struct stdio_dev *dev)
|
|
{
|
|
return serial_tstc();
|
|
}
|
|
|
|
/**************************************************************************
|
|
* SYSTEM DRIVERS
|
|
**************************************************************************
|
|
*/
|
|
|
|
static void drv_system_init (void)
|
|
{
|
|
struct stdio_dev dev;
|
|
|
|
memset (&dev, 0, sizeof (dev));
|
|
|
|
strcpy (dev.name, "serial");
|
|
dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
|
|
dev.putc = stdio_serial_putc;
|
|
dev.puts = stdio_serial_puts;
|
|
dev.getc = stdio_serial_getc;
|
|
dev.tstc = stdio_serial_tstc;
|
|
stdio_register (&dev);
|
|
|
|
#ifdef CONFIG_SYS_DEVICE_NULLDEV
|
|
memset (&dev, 0, sizeof (dev));
|
|
|
|
strcpy (dev.name, "nulldev");
|
|
dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
|
|
dev.putc = nulldev_putc;
|
|
dev.puts = nulldev_puts;
|
|
dev.getc = nulldev_input;
|
|
dev.tstc = nulldev_input;
|
|
|
|
stdio_register (&dev);
|
|
#endif
|
|
}
|
|
|
|
/**************************************************************************
|
|
* DEVICES
|
|
**************************************************************************
|
|
*/
|
|
struct list_head* stdio_get_list(void)
|
|
{
|
|
return &(devs.list);
|
|
}
|
|
|
|
struct stdio_dev* stdio_get_by_name(const char *name)
|
|
{
|
|
struct list_head *pos;
|
|
struct stdio_dev *dev;
|
|
|
|
if(!name)
|
|
return NULL;
|
|
|
|
list_for_each(pos, &(devs.list)) {
|
|
dev = list_entry(pos, struct stdio_dev, list);
|
|
if(strcmp(dev->name, name) == 0)
|
|
return dev;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
struct stdio_dev* stdio_clone(struct stdio_dev *dev)
|
|
{
|
|
struct stdio_dev *_dev;
|
|
|
|
if(!dev)
|
|
return NULL;
|
|
|
|
_dev = calloc(1, sizeof(struct stdio_dev));
|
|
|
|
if(!_dev)
|
|
return NULL;
|
|
|
|
memcpy(_dev, dev, sizeof(struct stdio_dev));
|
|
|
|
return _dev;
|
|
}
|
|
|
|
int stdio_register_dev(struct stdio_dev *dev, struct stdio_dev **devp)
|
|
{
|
|
struct stdio_dev *_dev;
|
|
|
|
_dev = stdio_clone(dev);
|
|
if(!_dev)
|
|
return -ENODEV;
|
|
list_add_tail(&(_dev->list), &(devs.list));
|
|
if (devp)
|
|
*devp = _dev;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int stdio_register(struct stdio_dev *dev)
|
|
{
|
|
return stdio_register_dev(dev, NULL);
|
|
}
|
|
|
|
/* deregister the device "devname".
|
|
* returns 0 if success, -1 if device is assigned and 1 if devname not found
|
|
*/
|
|
#ifdef CONFIG_SYS_STDIO_DEREGISTER
|
|
int stdio_deregister_dev(struct stdio_dev *dev)
|
|
{
|
|
int l;
|
|
struct list_head *pos;
|
|
char temp_names[3][16];
|
|
|
|
/* get stdio devices (ListRemoveItem changes the dev list) */
|
|
for (l=0 ; l< MAX_FILES; l++) {
|
|
if (stdio_devices[l] == dev) {
|
|
/* Device is assigned -> report error */
|
|
return -1;
|
|
}
|
|
memcpy (&temp_names[l][0],
|
|
stdio_devices[l]->name,
|
|
sizeof(temp_names[l]));
|
|
}
|
|
|
|
list_del(&(dev->list));
|
|
|
|
/* reassign Device list */
|
|
list_for_each(pos, &(devs.list)) {
|
|
dev = list_entry(pos, struct stdio_dev, list);
|
|
for (l=0 ; l< MAX_FILES; l++) {
|
|
if(strcmp(dev->name, temp_names[l]) == 0)
|
|
stdio_devices[l] = dev;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int stdio_deregister(const char *devname)
|
|
{
|
|
struct stdio_dev *dev;
|
|
|
|
dev = stdio_get_by_name(devname);
|
|
|
|
if (!dev) /* device not found */
|
|
return -ENODEV;
|
|
|
|
return stdio_deregister_dev(dev);
|
|
}
|
|
#endif /* CONFIG_SYS_STDIO_DEREGISTER */
|
|
|
|
int stdio_init_tables(void)
|
|
{
|
|
#if defined(CONFIG_NEEDS_MANUAL_RELOC)
|
|
/* already relocated for current ARM implementation */
|
|
ulong relocation_offset = gd->reloc_off;
|
|
int i;
|
|
|
|
/* relocate device name pointers */
|
|
for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
|
|
stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
|
|
relocation_offset);
|
|
}
|
|
#endif /* CONFIG_NEEDS_MANUAL_RELOC */
|
|
|
|
/* Initialize the list */
|
|
INIT_LIST_HEAD(&(devs.list));
|
|
|
|
return 0;
|
|
}
|
|
|
|
int stdio_add_devices(void)
|
|
{
|
|
#ifdef CONFIG_SYS_I2C
|
|
i2c_init_all();
|
|
#else
|
|
#if defined(CONFIG_HARD_I2C)
|
|
i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
|
|
#endif
|
|
#endif
|
|
#ifdef CONFIG_LCD
|
|
drv_lcd_init ();
|
|
#endif
|
|
#if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
|
|
drv_video_init ();
|
|
#endif
|
|
#ifdef CONFIG_KEYBOARD
|
|
drv_keyboard_init ();
|
|
#endif
|
|
#ifdef CONFIG_LOGBUFFER
|
|
drv_logbuff_init ();
|
|
#endif
|
|
drv_system_init ();
|
|
serial_stdio_init ();
|
|
#ifdef CONFIG_USB_TTY
|
|
drv_usbtty_init ();
|
|
#endif
|
|
#ifdef CONFIG_NETCONSOLE
|
|
drv_nc_init ();
|
|
#endif
|
|
#ifdef CONFIG_JTAG_CONSOLE
|
|
drv_jtag_console_init ();
|
|
#endif
|
|
#ifdef CONFIG_CBMEM_CONSOLE
|
|
cbmemc_init();
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int stdio_init(void)
|
|
{
|
|
stdio_init_tables();
|
|
stdio_add_devices();
|
|
|
|
return 0;
|
|
}
|