/*
   * 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
  static void nulldev_putc(struct stdio_dev *dev, const char c)
  {
  	/* nulldev is empty! */
  }
  
  static void nulldev_puts(struct stdio_dev *dev, const char *s)
  {
  	/* nulldev is empty! */
  }
  
  static int nulldev_input(struct stdio_dev *dev)
  {
  	/* nulldev is empty! */
  	return 0;
  }
  #endif
  
  static void stdio_serial_putc(struct stdio_dev *dev, const char c)
  {
  	serial_putc(c);
  }
  
  static void stdio_serial_puts(struct stdio_dev *dev, const char *s)
  {
  	serial_puts(s);
  }
  
  static int stdio_serial_getc(struct stdio_dev *dev)
  {
  	return serial_getc();
  }
  
  static 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));
  	free(dev);
  
  	/* 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;
  }