]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * (C) Copyright 2000 | |
3 | * Rob Taylor, Flying Pig Systems. [email protected]. | |
4 | * | |
5 | * SPDX-License-Identifier: GPL-2.0+ | |
6 | */ | |
7 | ||
8 | #include <common.h> | |
9 | #include <linux/compiler.h> | |
10 | ||
11 | #include <ns16550.h> | |
12 | #ifdef CONFIG_NS87308 | |
13 | #include <ns87308.h> | |
14 | #endif | |
15 | ||
16 | #include <serial.h> | |
17 | ||
18 | #ifndef CONFIG_NS16550_MIN_FUNCTIONS | |
19 | ||
20 | DECLARE_GLOBAL_DATA_PTR; | |
21 | ||
22 | #if !defined(CONFIG_CONS_INDEX) | |
23 | #elif (CONFIG_CONS_INDEX < 1) || (CONFIG_CONS_INDEX > 6) | |
24 | #error "Invalid console index value." | |
25 | #endif | |
26 | ||
27 | #if CONFIG_CONS_INDEX == 1 && !defined(CONFIG_SYS_NS16550_COM1) | |
28 | #error "Console port 1 defined but not configured." | |
29 | #elif CONFIG_CONS_INDEX == 2 && !defined(CONFIG_SYS_NS16550_COM2) | |
30 | #error "Console port 2 defined but not configured." | |
31 | #elif CONFIG_CONS_INDEX == 3 && !defined(CONFIG_SYS_NS16550_COM3) | |
32 | #error "Console port 3 defined but not configured." | |
33 | #elif CONFIG_CONS_INDEX == 4 && !defined(CONFIG_SYS_NS16550_COM4) | |
34 | #error "Console port 4 defined but not configured." | |
35 | #elif CONFIG_CONS_INDEX == 5 && !defined(CONFIG_SYS_NS16550_COM5) | |
36 | #error "Console port 5 defined but not configured." | |
37 | #elif CONFIG_CONS_INDEX == 6 && !defined(CONFIG_SYS_NS16550_COM6) | |
38 | #error "Console port 6 defined but not configured." | |
39 | #endif | |
40 | ||
41 | /* Note: The port number specified in the functions is 1 based. | |
42 | * the array is 0 based. | |
43 | */ | |
44 | static NS16550_t serial_ports[6] = { | |
45 | #ifdef CONFIG_SYS_NS16550_COM1 | |
46 | (NS16550_t)CONFIG_SYS_NS16550_COM1, | |
47 | #else | |
48 | NULL, | |
49 | #endif | |
50 | #ifdef CONFIG_SYS_NS16550_COM2 | |
51 | (NS16550_t)CONFIG_SYS_NS16550_COM2, | |
52 | #else | |
53 | NULL, | |
54 | #endif | |
55 | #ifdef CONFIG_SYS_NS16550_COM3 | |
56 | (NS16550_t)CONFIG_SYS_NS16550_COM3, | |
57 | #else | |
58 | NULL, | |
59 | #endif | |
60 | #ifdef CONFIG_SYS_NS16550_COM4 | |
61 | (NS16550_t)CONFIG_SYS_NS16550_COM4, | |
62 | #else | |
63 | NULL, | |
64 | #endif | |
65 | #ifdef CONFIG_SYS_NS16550_COM5 | |
66 | (NS16550_t)CONFIG_SYS_NS16550_COM5, | |
67 | #else | |
68 | NULL, | |
69 | #endif | |
70 | #ifdef CONFIG_SYS_NS16550_COM6 | |
71 | (NS16550_t)CONFIG_SYS_NS16550_COM6 | |
72 | #else | |
73 | NULL | |
74 | #endif | |
75 | }; | |
76 | ||
77 | #define PORT serial_ports[port-1] | |
78 | ||
79 | /* Multi serial device functions */ | |
80 | #define DECLARE_ESERIAL_FUNCTIONS(port) \ | |
81 | static int eserial##port##_init(void) \ | |
82 | { \ | |
83 | int clock_divisor; \ | |
84 | clock_divisor = ns16550_calc_divisor(serial_ports[port-1], \ | |
85 | CONFIG_SYS_NS16550_CLK, gd->baudrate); \ | |
86 | NS16550_init(serial_ports[port-1], clock_divisor); \ | |
87 | return 0 ; \ | |
88 | } \ | |
89 | static void eserial##port##_setbrg(void) \ | |
90 | { \ | |
91 | serial_setbrg_dev(port); \ | |
92 | } \ | |
93 | static int eserial##port##_getc(void) \ | |
94 | { \ | |
95 | return serial_getc_dev(port); \ | |
96 | } \ | |
97 | static int eserial##port##_tstc(void) \ | |
98 | { \ | |
99 | return serial_tstc_dev(port); \ | |
100 | } \ | |
101 | static void eserial##port##_putc(const char c) \ | |
102 | { \ | |
103 | serial_putc_dev(port, c); \ | |
104 | } \ | |
105 | static void eserial##port##_puts(const char *s) \ | |
106 | { \ | |
107 | serial_puts_dev(port, s); \ | |
108 | } | |
109 | ||
110 | /* Serial device descriptor */ | |
111 | #define INIT_ESERIAL_STRUCTURE(port, __name) { \ | |
112 | .name = __name, \ | |
113 | .start = eserial##port##_init, \ | |
114 | .stop = NULL, \ | |
115 | .setbrg = eserial##port##_setbrg, \ | |
116 | .getc = eserial##port##_getc, \ | |
117 | .tstc = eserial##port##_tstc, \ | |
118 | .putc = eserial##port##_putc, \ | |
119 | .puts = eserial##port##_puts, \ | |
120 | } | |
121 | ||
122 | static void _serial_putc(const char c, const int port) | |
123 | { | |
124 | if (c == '\n') | |
125 | NS16550_putc(PORT, '\r'); | |
126 | ||
127 | NS16550_putc(PORT, c); | |
128 | } | |
129 | ||
130 | static void _serial_puts(const char *s, const int port) | |
131 | { | |
132 | while (*s) { | |
133 | _serial_putc(*s++, port); | |
134 | } | |
135 | } | |
136 | ||
137 | static int _serial_getc(const int port) | |
138 | { | |
139 | return NS16550_getc(PORT); | |
140 | } | |
141 | ||
142 | static int _serial_tstc(const int port) | |
143 | { | |
144 | return NS16550_tstc(PORT); | |
145 | } | |
146 | ||
147 | static void _serial_setbrg(const int port) | |
148 | { | |
149 | int clock_divisor; | |
150 | ||
151 | clock_divisor = ns16550_calc_divisor(PORT, CONFIG_SYS_NS16550_CLK, | |
152 | gd->baudrate); | |
153 | NS16550_reinit(PORT, clock_divisor); | |
154 | } | |
155 | ||
156 | static inline void | |
157 | serial_putc_dev(unsigned int dev_index,const char c) | |
158 | { | |
159 | _serial_putc(c,dev_index); | |
160 | } | |
161 | ||
162 | static inline void | |
163 | serial_puts_dev(unsigned int dev_index,const char *s) | |
164 | { | |
165 | _serial_puts(s,dev_index); | |
166 | } | |
167 | ||
168 | static inline int | |
169 | serial_getc_dev(unsigned int dev_index) | |
170 | { | |
171 | return _serial_getc(dev_index); | |
172 | } | |
173 | ||
174 | static inline int | |
175 | serial_tstc_dev(unsigned int dev_index) | |
176 | { | |
177 | return _serial_tstc(dev_index); | |
178 | } | |
179 | ||
180 | static inline void | |
181 | serial_setbrg_dev(unsigned int dev_index) | |
182 | { | |
183 | _serial_setbrg(dev_index); | |
184 | } | |
185 | ||
186 | #if defined(CONFIG_SYS_NS16550_COM1) | |
187 | DECLARE_ESERIAL_FUNCTIONS(1); | |
188 | struct serial_device eserial1_device = | |
189 | INIT_ESERIAL_STRUCTURE(1, "eserial0"); | |
190 | #endif | |
191 | #if defined(CONFIG_SYS_NS16550_COM2) | |
192 | DECLARE_ESERIAL_FUNCTIONS(2); | |
193 | struct serial_device eserial2_device = | |
194 | INIT_ESERIAL_STRUCTURE(2, "eserial1"); | |
195 | #endif | |
196 | #if defined(CONFIG_SYS_NS16550_COM3) | |
197 | DECLARE_ESERIAL_FUNCTIONS(3); | |
198 | struct serial_device eserial3_device = | |
199 | INIT_ESERIAL_STRUCTURE(3, "eserial2"); | |
200 | #endif | |
201 | #if defined(CONFIG_SYS_NS16550_COM4) | |
202 | DECLARE_ESERIAL_FUNCTIONS(4); | |
203 | struct serial_device eserial4_device = | |
204 | INIT_ESERIAL_STRUCTURE(4, "eserial3"); | |
205 | #endif | |
206 | #if defined(CONFIG_SYS_NS16550_COM5) | |
207 | DECLARE_ESERIAL_FUNCTIONS(5); | |
208 | struct serial_device eserial5_device = | |
209 | INIT_ESERIAL_STRUCTURE(5, "eserial4"); | |
210 | #endif | |
211 | #if defined(CONFIG_SYS_NS16550_COM6) | |
212 | DECLARE_ESERIAL_FUNCTIONS(6); | |
213 | struct serial_device eserial6_device = | |
214 | INIT_ESERIAL_STRUCTURE(6, "eserial5"); | |
215 | #endif | |
216 | ||
217 | __weak struct serial_device *default_serial_console(void) | |
218 | { | |
219 | #if CONFIG_CONS_INDEX == 1 | |
220 | return &eserial1_device; | |
221 | #elif CONFIG_CONS_INDEX == 2 | |
222 | return &eserial2_device; | |
223 | #elif CONFIG_CONS_INDEX == 3 | |
224 | return &eserial3_device; | |
225 | #elif CONFIG_CONS_INDEX == 4 | |
226 | return &eserial4_device; | |
227 | #elif CONFIG_CONS_INDEX == 5 | |
228 | return &eserial5_device; | |
229 | #elif CONFIG_CONS_INDEX == 6 | |
230 | return &eserial6_device; | |
231 | #else | |
232 | #error "Bad CONFIG_CONS_INDEX." | |
233 | #endif | |
234 | } | |
235 | ||
236 | void ns16550_serial_initialize(void) | |
237 | { | |
238 | #if defined(CONFIG_SYS_NS16550_COM1) | |
239 | serial_register(&eserial1_device); | |
240 | #endif | |
241 | #if defined(CONFIG_SYS_NS16550_COM2) | |
242 | serial_register(&eserial2_device); | |
243 | #endif | |
244 | #if defined(CONFIG_SYS_NS16550_COM3) | |
245 | serial_register(&eserial3_device); | |
246 | #endif | |
247 | #if defined(CONFIG_SYS_NS16550_COM4) | |
248 | serial_register(&eserial4_device); | |
249 | #endif | |
250 | #if defined(CONFIG_SYS_NS16550_COM5) | |
251 | serial_register(&eserial5_device); | |
252 | #endif | |
253 | #if defined(CONFIG_SYS_NS16550_COM6) | |
254 | serial_register(&eserial6_device); | |
255 | #endif | |
256 | } | |
257 | ||
258 | #endif /* !CONFIG_NS16550_MIN_FUNCTIONS */ |