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