stdio.c 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252
  1. /*
  2. * (C) Copyright 2000
  3. * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
  4. *
  5. * See file CREDITS for list of people who contributed to this
  6. * project.
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License as
  10. * published by the Free Software Foundation; either version 2 of
  11. * the License, or (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21. * MA 02111-1307 USA
  22. */
  23. #include <config.h>
  24. #include <common.h>
  25. #include <stdarg.h>
  26. #include <malloc.h>
  27. #include <stdio_dev.h>
  28. #include <serial.h>
  29. #ifdef CONFIG_LOGBUFFER
  30. #include <logbuff.h>
  31. #endif
  32. #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
  33. #include <i2c.h>
  34. #endif
  35. DECLARE_GLOBAL_DATA_PTR;
  36. static struct stdio_dev devs;
  37. struct stdio_dev *stdio_devices[] = { NULL, NULL, NULL };
  38. char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };
  39. #if defined(CONFIG_SPLASH_SCREEN) && !defined(CONFIG_SYS_DEVICE_NULLDEV)
  40. #define CONFIG_SYS_DEVICE_NULLDEV 1
  41. #endif
  42. #ifdef CONFIG_SYS_DEVICE_NULLDEV
  43. void nulldev_putc(const char c)
  44. {
  45. /* nulldev is empty! */
  46. }
  47. void nulldev_puts(const char *s)
  48. {
  49. /* nulldev is empty! */
  50. }
  51. int nulldev_input(void)
  52. {
  53. /* nulldev is empty! */
  54. return 0;
  55. }
  56. #endif
  57. /**************************************************************************
  58. * SYSTEM DRIVERS
  59. **************************************************************************
  60. */
  61. static void drv_system_init (void)
  62. {
  63. struct stdio_dev dev;
  64. memset (&dev, 0, sizeof (dev));
  65. strcpy (dev.name, "serial");
  66. dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
  67. #ifdef CONFIG_SERIAL_SOFTWARE_FIFO
  68. dev.putc = serial_buffered_putc;
  69. dev.puts = serial_buffered_puts;
  70. dev.getc = serial_buffered_getc;
  71. dev.tstc = serial_buffered_tstc;
  72. #else
  73. dev.putc = serial_putc;
  74. dev.puts = serial_puts;
  75. dev.getc = serial_getc;
  76. dev.tstc = serial_tstc;
  77. #endif
  78. stdio_register (&dev);
  79. #ifdef CONFIG_SYS_DEVICE_NULLDEV
  80. memset (&dev, 0, sizeof (dev));
  81. strcpy (dev.name, "nulldev");
  82. dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
  83. dev.putc = nulldev_putc;
  84. dev.puts = nulldev_puts;
  85. dev.getc = nulldev_input;
  86. dev.tstc = nulldev_input;
  87. stdio_register (&dev);
  88. #endif
  89. }
  90. /**************************************************************************
  91. * DEVICES
  92. **************************************************************************
  93. */
  94. struct list_head* stdio_get_list(void)
  95. {
  96. return &(devs.list);
  97. }
  98. struct stdio_dev* stdio_get_by_name(char* name)
  99. {
  100. struct list_head *pos;
  101. struct stdio_dev *dev;
  102. if(!name)
  103. return NULL;
  104. list_for_each(pos, &(devs.list)) {
  105. dev = list_entry(pos, struct stdio_dev, list);
  106. if(strcmp(dev->name, name) == 0)
  107. return dev;
  108. }
  109. return NULL;
  110. }
  111. struct stdio_dev* stdio_clone(struct stdio_dev *dev)
  112. {
  113. struct stdio_dev *_dev;
  114. if(!dev)
  115. return NULL;
  116. _dev = calloc(1, sizeof(struct stdio_dev));
  117. if(!_dev)
  118. return NULL;
  119. memcpy(_dev, dev, sizeof(struct stdio_dev));
  120. strncpy(_dev->name, dev->name, 16);
  121. return _dev;
  122. }
  123. int stdio_register (struct stdio_dev * dev)
  124. {
  125. struct stdio_dev *_dev;
  126. _dev = stdio_clone(dev);
  127. if(!_dev)
  128. return -1;
  129. list_add_tail(&(_dev->list), &(devs.list));
  130. return 0;
  131. }
  132. /* deregister the device "devname".
  133. * returns 0 if success, -1 if device is assigned and 1 if devname not found
  134. */
  135. #ifdef CONFIG_SYS_STDIO_DEREGISTER
  136. int stdio_deregister(char *devname)
  137. {
  138. int l;
  139. struct list_head *pos;
  140. struct stdio_dev *dev;
  141. char temp_names[3][8];
  142. dev = stdio_get_by_name(devname);
  143. if(!dev) /* device not found */
  144. return -1;
  145. /* get stdio devices (ListRemoveItem changes the dev list) */
  146. for (l=0 ; l< MAX_FILES; l++) {
  147. if (stdio_devices[l] == dev) {
  148. /* Device is assigned -> report error */
  149. return -1;
  150. }
  151. memcpy (&temp_names[l][0],
  152. stdio_devices[l]->name,
  153. sizeof(stdio_devices[l]->name));
  154. }
  155. list_del(&(dev->list));
  156. /* reassign Device list */
  157. list_for_each(pos, &(devs.list)) {
  158. dev = list_entry(pos, struct stdio_dev, list);
  159. for (l=0 ; l< MAX_FILES; l++) {
  160. if(strcmp(dev->name, temp_names[l]) == 0)
  161. stdio_devices[l] = dev;
  162. }
  163. }
  164. return 0;
  165. }
  166. #endif /* CONFIG_SYS_STDIO_DEREGISTER */
  167. int stdio_init (void)
  168. {
  169. #if !defined(CONFIG_RELOC_FIXUP_WORKS)
  170. /* already relocated for current ARM implementation */
  171. ulong relocation_offset = gd->reloc_off;
  172. int i;
  173. /* relocate device name pointers */
  174. for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
  175. stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
  176. relocation_offset);
  177. }
  178. #endif /* !CONFIG_RELOC_FIXUP_WORKS */
  179. /* Initialize the list */
  180. INIT_LIST_HEAD(&(devs.list));
  181. #ifdef CONFIG_ARM_DCC_MULTI
  182. drv_arm_dcc_init ();
  183. #endif
  184. #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
  185. i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
  186. #endif
  187. #ifdef CONFIG_LCD
  188. drv_lcd_init ();
  189. #endif
  190. #if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
  191. drv_video_init ();
  192. #endif
  193. #ifdef CONFIG_KEYBOARD
  194. drv_keyboard_init ();
  195. #endif
  196. #ifdef CONFIG_LOGBUFFER
  197. drv_logbuff_init ();
  198. #endif
  199. drv_system_init ();
  200. #ifdef CONFIG_SERIAL_MULTI
  201. serial_stdio_init ();
  202. #endif
  203. #ifdef CONFIG_USB_TTY
  204. drv_usbtty_init ();
  205. #endif
  206. #ifdef CONFIG_NETCONSOLE
  207. drv_nc_init ();
  208. #endif
  209. #ifdef CONFIG_JTAG_CONSOLE
  210. drv_jtag_console_init ();
  211. #endif
  212. return (0);
  213. }