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