stdio.c 5.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291
  1. /*
  2. * Copyright (C) 2009 Sergey Kubushyn <ksi@koi8.net>
  3. *
  4. * Changes for multibus/multiadapter I2C support.
  5. *
  6. * (C) Copyright 2000
  7. * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
  8. *
  9. * SPDX-License-Identifier: GPL-2.0+
  10. */
  11. #include <config.h>
  12. #include <common.h>
  13. #include <errno.h>
  14. #include <stdarg.h>
  15. #include <malloc.h>
  16. #include <stdio_dev.h>
  17. #include <serial.h>
  18. #ifdef CONFIG_LOGBUFFER
  19. #include <logbuff.h>
  20. #endif
  21. #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
  22. #include <i2c.h>
  23. #endif
  24. DECLARE_GLOBAL_DATA_PTR;
  25. static struct stdio_dev devs;
  26. struct stdio_dev *stdio_devices[] = { NULL, NULL, NULL };
  27. char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };
  28. #if defined(CONFIG_SPLASH_SCREEN) && !defined(CONFIG_SYS_DEVICE_NULLDEV)
  29. #define CONFIG_SYS_DEVICE_NULLDEV 1
  30. #endif
  31. #ifdef CONFIG_SYS_STDIO_DEREGISTER
  32. #define CONFIG_SYS_DEVICE_NULLDEV 1
  33. #endif
  34. #ifdef CONFIG_SYS_DEVICE_NULLDEV
  35. static void nulldev_putc(struct stdio_dev *dev, const char c)
  36. {
  37. /* nulldev is empty! */
  38. }
  39. static void nulldev_puts(struct stdio_dev *dev, const char *s)
  40. {
  41. /* nulldev is empty! */
  42. }
  43. static int nulldev_input(struct stdio_dev *dev)
  44. {
  45. /* nulldev is empty! */
  46. return 0;
  47. }
  48. #endif
  49. static void stdio_serial_putc(struct stdio_dev *dev, const char c)
  50. {
  51. serial_putc(c);
  52. }
  53. static void stdio_serial_puts(struct stdio_dev *dev, const char *s)
  54. {
  55. serial_puts(s);
  56. }
  57. static int stdio_serial_getc(struct stdio_dev *dev)
  58. {
  59. return serial_getc();
  60. }
  61. static int stdio_serial_tstc(struct stdio_dev *dev)
  62. {
  63. return serial_tstc();
  64. }
  65. /**************************************************************************
  66. * SYSTEM DRIVERS
  67. **************************************************************************
  68. */
  69. static void drv_system_init (void)
  70. {
  71. struct stdio_dev dev;
  72. memset (&dev, 0, sizeof (dev));
  73. strcpy (dev.name, "serial");
  74. dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
  75. dev.putc = stdio_serial_putc;
  76. dev.puts = stdio_serial_puts;
  77. dev.getc = stdio_serial_getc;
  78. dev.tstc = stdio_serial_tstc;
  79. stdio_register (&dev);
  80. #ifdef CONFIG_SYS_DEVICE_NULLDEV
  81. memset (&dev, 0, sizeof (dev));
  82. strcpy (dev.name, "nulldev");
  83. dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
  84. dev.putc = nulldev_putc;
  85. dev.puts = nulldev_puts;
  86. dev.getc = nulldev_input;
  87. dev.tstc = nulldev_input;
  88. stdio_register (&dev);
  89. #endif
  90. }
  91. /**************************************************************************
  92. * DEVICES
  93. **************************************************************************
  94. */
  95. struct list_head* stdio_get_list(void)
  96. {
  97. return &(devs.list);
  98. }
  99. struct stdio_dev* stdio_get_by_name(const char *name)
  100. {
  101. struct list_head *pos;
  102. struct stdio_dev *dev;
  103. if(!name)
  104. return NULL;
  105. list_for_each(pos, &(devs.list)) {
  106. dev = list_entry(pos, struct stdio_dev, list);
  107. if(strcmp(dev->name, name) == 0)
  108. return dev;
  109. }
  110. return NULL;
  111. }
  112. struct stdio_dev* stdio_clone(struct stdio_dev *dev)
  113. {
  114. struct stdio_dev *_dev;
  115. if(!dev)
  116. return NULL;
  117. _dev = calloc(1, sizeof(struct stdio_dev));
  118. if(!_dev)
  119. return NULL;
  120. memcpy(_dev, dev, sizeof(struct stdio_dev));
  121. return _dev;
  122. }
  123. int stdio_register_dev(struct stdio_dev *dev, struct stdio_dev **devp)
  124. {
  125. struct stdio_dev *_dev;
  126. _dev = stdio_clone(dev);
  127. if(!_dev)
  128. return -ENODEV;
  129. list_add_tail(&(_dev->list), &(devs.list));
  130. if (devp)
  131. *devp = _dev;
  132. return 0;
  133. }
  134. int stdio_register(struct stdio_dev *dev)
  135. {
  136. return stdio_register_dev(dev, NULL);
  137. }
  138. /* deregister the device "devname".
  139. * returns 0 if success, -1 if device is assigned and 1 if devname not found
  140. */
  141. #ifdef CONFIG_SYS_STDIO_DEREGISTER
  142. int stdio_deregister_dev(struct stdio_dev *dev, int force)
  143. {
  144. int l;
  145. struct list_head *pos;
  146. char temp_names[3][16];
  147. /* get stdio devices (ListRemoveItem changes the dev list) */
  148. for (l=0 ; l< MAX_FILES; l++) {
  149. if (stdio_devices[l] == dev) {
  150. if (force) {
  151. strcpy(temp_names[l], "nulldev");
  152. continue;
  153. }
  154. /* Device is assigned -> report error */
  155. return -1;
  156. }
  157. memcpy (&temp_names[l][0],
  158. stdio_devices[l]->name,
  159. sizeof(temp_names[l]));
  160. }
  161. list_del(&(dev->list));
  162. free(dev);
  163. /* reassign Device list */
  164. list_for_each(pos, &(devs.list)) {
  165. dev = list_entry(pos, struct stdio_dev, list);
  166. for (l=0 ; l< MAX_FILES; l++) {
  167. if(strcmp(dev->name, temp_names[l]) == 0)
  168. stdio_devices[l] = dev;
  169. }
  170. }
  171. return 0;
  172. }
  173. int stdio_deregister(const char *devname, int force)
  174. {
  175. struct stdio_dev *dev;
  176. dev = stdio_get_by_name(devname);
  177. if (!dev) /* device not found */
  178. return -ENODEV;
  179. return stdio_deregister_dev(dev, force);
  180. }
  181. #endif /* CONFIG_SYS_STDIO_DEREGISTER */
  182. int stdio_init_tables(void)
  183. {
  184. #if defined(CONFIG_NEEDS_MANUAL_RELOC)
  185. /* already relocated for current ARM implementation */
  186. ulong relocation_offset = gd->reloc_off;
  187. int i;
  188. /* relocate device name pointers */
  189. for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
  190. stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
  191. relocation_offset);
  192. }
  193. #endif /* CONFIG_NEEDS_MANUAL_RELOC */
  194. /* Initialize the list */
  195. INIT_LIST_HEAD(&(devs.list));
  196. return 0;
  197. }
  198. int stdio_add_devices(void)
  199. {
  200. #ifdef CONFIG_SYS_I2C
  201. i2c_init_all();
  202. #else
  203. #if defined(CONFIG_HARD_I2C)
  204. i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
  205. #endif
  206. #endif
  207. #ifdef CONFIG_LCD
  208. drv_lcd_init ();
  209. #endif
  210. #if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
  211. drv_video_init ();
  212. #endif
  213. #ifdef CONFIG_KEYBOARD
  214. drv_keyboard_init ();
  215. #endif
  216. #ifdef CONFIG_LOGBUFFER
  217. drv_logbuff_init ();
  218. #endif
  219. drv_system_init ();
  220. serial_stdio_init ();
  221. #ifdef CONFIG_USB_TTY
  222. drv_usbtty_init ();
  223. #endif
  224. #ifdef CONFIG_NETCONSOLE
  225. drv_nc_init ();
  226. #endif
  227. #ifdef CONFIG_JTAG_CONSOLE
  228. drv_jtag_console_init ();
  229. #endif
  230. #ifdef CONFIG_CBMEM_CONSOLE
  231. cbmemc_init();
  232. #endif
  233. return 0;
  234. }
  235. int stdio_init(void)
  236. {
  237. stdio_init_tables();
  238. stdio_add_devices();
  239. return 0;
  240. }