]> git.sur5r.net Git - u-boot/blob - common/devices.c
New board directory and config for the benq delta board (copied from
[u-boot] / common / devices.c
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
24 #include <config.h>
25 #include <common.h>
26 #include <stdarg.h>
27 #include <malloc.h>
28 #include <devices.h>
29 #include <serial.h>
30 #ifdef CONFIG_LOGBUFFER
31 #include <logbuff.h>
32 #endif
33 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
34 #include <i2c.h>
35 #endif
36
37 list_t devlist = 0;
38 device_t *stdio_devices[] = { NULL, NULL, NULL };
39 char *stdio_names[MAX_FILES] = { "stdin", "stdout", "stderr" };
40
41 #if defined(CONFIG_SPLASH_SCREEN) && !defined(CFG_DEVICE_NULLDEV)
42 #define CFG_DEVICE_NULLDEV      1
43 #endif
44
45
46 #ifdef CFG_DEVICE_NULLDEV
47 void nulldev_putc(const char c)
48 {
49   /* nulldev is empty! */
50 }
51
52 void nulldev_puts(const char *s)
53 {
54   /* nulldev is empty! */
55 }
56
57 int nulldev_input(void)
58 {
59   /* nulldev is empty! */
60   return 0;
61 }
62 #endif
63
64 /**************************************************************************
65  * SYSTEM DRIVERS
66  **************************************************************************
67  */
68
69 static void drv_system_init (void)
70 {
71         device_t dev;
72
73         memset (&dev, 0, sizeof (dev));
74
75         strcpy (dev.name, "serial");
76         dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
77 #ifdef CONFIG_SERIAL_SOFTWARE_FIFO
78         dev.putc = serial_buffered_putc;
79         dev.puts = serial_buffered_puts;
80         dev.getc = serial_buffered_getc;
81         dev.tstc = serial_buffered_tstc;
82 #else
83         dev.putc = serial_putc;
84         dev.puts = serial_puts;
85         dev.getc = serial_getc;
86         dev.tstc = serial_tstc;
87 #endif
88
89         device_register (&dev);
90
91 #ifdef CFG_DEVICE_NULLDEV
92         memset (&dev, 0, sizeof (dev));
93
94         strcpy (dev.name, "nulldev");
95         dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
96         dev.putc = nulldev_putc;
97         dev.puts = nulldev_puts;
98         dev.getc = nulldev_input;
99         dev.tstc = nulldev_input;
100
101         device_register (&dev);
102 #endif
103 }
104
105 /**************************************************************************
106  * DEVICES
107  **************************************************************************
108  */
109
110 int device_register (device_t * dev)
111 {
112         ListInsertItem (devlist, dev, LIST_END);
113         return 0;
114 }
115
116 /* deregister the device "devname".
117  * returns 0 if success, -1 if device is assigned and 1 if devname not found
118  */
119 #ifdef  CFG_DEVICE_DEREGISTER
120 int device_deregister(char *devname)
121 {
122         int i,l,dev_index;
123         device_t *dev = NULL;
124         char temp_names[3][8];
125
126         dev_index=-1;
127         for (i=1; i<=ListNumItems(devlist); i++) {
128                 dev = ListGetPtrToItem (devlist, i);
129                 if(strcmp(dev->name,devname)==0) {
130                         dev_index=i;
131                         break;
132                 }
133         }
134         if(dev_index<0) /* device not found */
135                 return 0;
136         /* get stdio devices (ListRemoveItem changes the dev list) */
137         for (l=0 ; l< MAX_FILES; l++) {
138                 if (stdio_devices[l] == dev) {
139                         /* Device is assigned -> report error */
140                         return -1;
141                 }
142                 memcpy (&temp_names[l][0],
143                         stdio_devices[l]->name,
144                         sizeof(stdio_devices[l]->name));
145         }
146         ListRemoveItem(devlist,NULL,dev_index);
147         /* reassign Device list */
148         for (i=1; i<=ListNumItems(devlist); i++) {
149                 dev = ListGetPtrToItem (devlist, i);
150                 for (l=0 ; l< MAX_FILES; l++) {
151                         if(strcmp(dev->name,temp_names[l])==0) {
152                                 stdio_devices[l] = dev;
153                         }
154                 }
155         }
156         return 0;
157 }
158 #endif  /* CFG_DEVICE_DEREGISTER */
159
160 int devices_init (void)
161 {
162 #ifndef CONFIG_ARM     /* already relocated for current ARM implementation */
163         DECLARE_GLOBAL_DATA_PTR;
164
165         ulong relocation_offset = gd->reloc_off;
166         int i;
167
168         /* relocate device name pointers */
169         for (i = 0; i < (sizeof (stdio_names) / sizeof (char *)); ++i) {
170                 stdio_names[i] = (char *) (((ulong) stdio_names[i]) +
171                                                 relocation_offset);
172         }
173 #endif
174
175         /* Initialize the list */
176         devlist = ListCreate (sizeof (device_t));
177
178         if (devlist == NULL) {
179                 eputs ("Cannot initialize the list of devices!\n");
180                 return -1;
181         }
182 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C)
183         i2c_init (CFG_I2C_SPEED, CFG_I2C_SLAVE);
184 #endif
185 #ifdef CONFIG_LCD
186         drv_lcd_init ();
187 #endif
188 #if defined(CONFIG_VIDEO) || defined(CONFIG_CFB_CONSOLE)
189         drv_video_init ();
190 #endif
191 #ifdef CONFIG_KEYBOARD
192         drv_keyboard_init ();
193 #endif
194 #ifdef CONFIG_LOGBUFFER
195         drv_logbuff_init ();
196 #endif
197         drv_system_init ();
198 #ifdef CONFIG_SERIAL_MULTI
199         serial_devices_init ();
200 #endif
201 #ifdef CONFIG_USB_TTY
202         drv_usbtty_init ();
203 #endif
204 #ifdef CONFIG_NETCONSOLE
205         drv_nc_init ();
206 #endif
207
208         return (0);
209 }
210
211 int devices_done (void)
212 {
213         ListDispose (devlist);
214
215         return 0;
216 }