/*

   * 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_STDIO_DEREGISTER
  #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 force)

  {

  	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) {

  			if (force) {
  				strcpy(temp_names[l], "nulldev");
  				continue;
  			}

  			/* 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, int force)

  {
  	struct stdio_dev *dev;
  
  	dev = stdio_get_by_name(devname);
  
  	if (!dev) /* device not found */
  		return -ENODEV;

  	return stdio_deregister_dev(dev, force);

  }

  #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;

  }