Merge branch 'u-boot-ti/master' into 'u-boot-arm/master'
[platform/kernel/u-boot.git] / common / iomux.c
1 /*
2  * (C) Copyright 2008
3  * Gary Jennejohn, DENX Software Engineering GmbH, garyj@denx.de.
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 <common.h>
25 #include <serial.h>
26 #include <malloc.h>
27
28 #ifdef CONFIG_CONSOLE_MUX
29 void iomux_printdevs(const int console)
30 {
31         int i;
32         struct stdio_dev *dev;
33
34         for (i = 0; i < cd_count[console]; i++) {
35                 dev = console_devices[console][i];
36                 printf("%s ", dev->name);
37         }
38         printf("\n");
39 }
40
41 /* This tries to preserve the old list if an error occurs. */
42 int iomux_doenv(const int console, const char *arg)
43 {
44         char *console_args, *temp, **start;
45         int i, j, k, io_flag, cs_idx, repeat;
46         struct stdio_dev *dev;
47         struct stdio_dev **cons_set;
48
49         console_args = strdup(arg);
50         if (console_args == NULL)
51                 return 1;
52         /*
53          * Check whether a comma separated list of devices was
54          * entered and count how many devices were entered.
55          * The array start[] has pointers to the beginning of
56          * each device name (up to MAX_CONSARGS devices).
57          *
58          * Have to do this twice - once to count the number of
59          * commas and then again to populate start.
60          */
61         i = 0;
62         temp = console_args;
63         for (;;) {
64                 temp = strchr(temp, ',');
65                 if (temp != NULL) {
66                         i++;
67                         temp++;
68                         continue;
69                 }
70                 /* There's always one entry more than the number of commas. */
71                 i++;
72                 break;
73         }
74         start = (char **)malloc(i * sizeof(char *));
75         if (start == NULL) {
76                 free(console_args);
77                 return 1;
78         }
79         i = 0;
80         start[0] = console_args;
81         for (;;) {
82                 temp = strchr(start[i++], ',');
83                 if (temp == NULL)
84                         break;
85                 *temp = '\0';
86                 start[i] = temp + 1;
87         }
88         cons_set = (struct stdio_dev **)calloc(i, sizeof(struct stdio_dev *));
89         if (cons_set == NULL) {
90                 free(start);
91                 free(console_args);
92                 return 1;
93         }
94
95         switch (console) {
96         case stdin:
97                 io_flag = DEV_FLAGS_INPUT;
98                 break;
99         case stdout:
100         case stderr:
101                 io_flag = DEV_FLAGS_OUTPUT;
102                 break;
103         default:
104                 free(start);
105                 free(console_args);
106                 free(cons_set);
107                 return 1;
108         }
109
110         cs_idx = 0;
111         for (j = 0; j < i; j++) {
112                 /*
113                  * Check whether the device exists and is valid.
114                  * console_assign() also calls search_device(),
115                  * but I need the pointer to the device.
116                  */
117                 dev = search_device(io_flag, start[j]);
118                 if (dev == NULL)
119                         continue;
120                 /*
121                  * Prevent multiple entries for a device.
122                  */
123                  repeat = 0;
124                  for (k = 0; k < cs_idx; k++) {
125                         if (dev == cons_set[k]) {
126                                 repeat++;
127                                 break;
128                         }
129                  }
130                  if (repeat)
131                         continue;
132                 /*
133                  * Try assigning the specified device.
134                  * This could screw up the console settings for apps.
135                  */
136                 if (console_assign(console, start[j]) < 0)
137                         continue;
138                 cons_set[cs_idx++] = dev;
139         }
140         free(console_args);
141         free(start);
142         /* failed to set any console */
143         if (cs_idx == 0) {
144                 free(cons_set);
145                 return 1;
146         } else {
147                 /* Works even if console_devices[console] is NULL. */
148                 console_devices[console] =
149                         (struct stdio_dev **)realloc(console_devices[console],
150                         cs_idx * sizeof(struct stdio_dev *));
151                 if (console_devices[console] == NULL) {
152                         free(cons_set);
153                         return 1;
154                 }
155                 memcpy(console_devices[console], cons_set, cs_idx *
156                         sizeof(struct stdio_dev *));
157
158                 cd_count[console] = cs_idx;
159         }
160         free(cons_set);
161         return 0;
162 }
163 #endif /* CONFIG_CONSOLE_MUX */