1
2
3
4
5
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
20DECLARE_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
42
43
44static 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
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
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
122static 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
130static void _serial_puts(const char *s, const int port)
131{
132 while (*s) {
133 _serial_putc(*s++, port);
134 }
135}
136
137static int _serial_getc(const int port)
138{
139 return NS16550_getc(PORT);
140}
141
142static int _serial_tstc(const int port)
143{
144 return NS16550_tstc(PORT);
145}
146
147static 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
156static inline void
157serial_putc_dev(unsigned int dev_index,const char c)
158{
159 _serial_putc(c,dev_index);
160}
161
162static inline void
163serial_puts_dev(unsigned int dev_index,const char *s)
164{
165 _serial_puts(s,dev_index);
166}
167
168static inline int
169serial_getc_dev(unsigned int dev_index)
170{
171 return _serial_getc(dev_index);
172}
173
174static inline int
175serial_tstc_dev(unsigned int dev_index)
176{
177 return _serial_tstc(dev_index);
178}
179
180static inline void
181serial_setbrg_dev(unsigned int dev_index)
182{
183 _serial_setbrg(dev_index);
184}
185
186#if defined(CONFIG_SYS_NS16550_COM1)
187DECLARE_ESERIAL_FUNCTIONS(1);
188struct serial_device eserial1_device =
189 INIT_ESERIAL_STRUCTURE(1, "eserial0");
190#endif
191#if defined(CONFIG_SYS_NS16550_COM2)
192DECLARE_ESERIAL_FUNCTIONS(2);
193struct serial_device eserial2_device =
194 INIT_ESERIAL_STRUCTURE(2, "eserial1");
195#endif
196#if defined(CONFIG_SYS_NS16550_COM3)
197DECLARE_ESERIAL_FUNCTIONS(3);
198struct serial_device eserial3_device =
199 INIT_ESERIAL_STRUCTURE(3, "eserial2");
200#endif
201#if defined(CONFIG_SYS_NS16550_COM4)
202DECLARE_ESERIAL_FUNCTIONS(4);
203struct serial_device eserial4_device =
204 INIT_ESERIAL_STRUCTURE(4, "eserial3");
205#endif
206#if defined(CONFIG_SYS_NS16550_COM5)
207DECLARE_ESERIAL_FUNCTIONS(5);
208struct serial_device eserial5_device =
209 INIT_ESERIAL_STRUCTURE(5, "eserial4");
210#endif
211#if defined(CONFIG_SYS_NS16550_COM6)
212DECLARE_ESERIAL_FUNCTIONS(6);
213struct 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
236void 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
259
