[people/ms/u-boot.git] / drivers / serial / serial_ns16550.c

/*
 * (C) Copyright 2000
 * Rob Taylor, Flying Pig Systems. robt@flyingpig.com.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <linux/compiler.h>

#include <ns16550.h>
#ifdef CONFIG_NS87308
#include <ns87308.h>
#endif

#include <serial.h>

#ifndef CONFIG_NS16550_MIN_FUNCTIONS

DECLARE_GLOBAL_DATA_PTR;

#if !defined(CONFIG_CONS_INDEX)
#elif (CONFIG_CONS_INDEX < 1) || (CONFIG_CONS_INDEX > 6)
#error	"Invalid console index value."
#endif

#if CONFIG_CONS_INDEX == 1 && !defined(CONFIG_SYS_NS16550_COM1)
#error	"Console port 1 defined but not configured."
#elif CONFIG_CONS_INDEX == 2 && !defined(CONFIG_SYS_NS16550_COM2)
#error	"Console port 2 defined but not configured."
#elif CONFIG_CONS_INDEX == 3 && !defined(CONFIG_SYS_NS16550_COM3)
#error	"Console port 3 defined but not configured."
#elif CONFIG_CONS_INDEX == 4 && !defined(CONFIG_SYS_NS16550_COM4)
#error	"Console port 4 defined but not configured."
#elif CONFIG_CONS_INDEX == 5 && !defined(CONFIG_SYS_NS16550_COM5)
#error	"Console port 5 defined but not configured."
#elif CONFIG_CONS_INDEX == 6 && !defined(CONFIG_SYS_NS16550_COM6)
#error	"Console port 6 defined but not configured."
#endif

/* Note: The port number specified in the functions is 1 based.
 *	 the array is 0 based.
 */
static NS16550_t serial_ports[6] = {
#ifdef CONFIG_SYS_NS16550_COM1
	(NS16550_t)CONFIG_SYS_NS16550_COM1,
#else
	NULL,
#endif
#ifdef CONFIG_SYS_NS16550_COM2
	(NS16550_t)CONFIG_SYS_NS16550_COM2,
#else
	NULL,
#endif
#ifdef CONFIG_SYS_NS16550_COM3
	(NS16550_t)CONFIG_SYS_NS16550_COM3,
#else
	NULL,
#endif
#ifdef CONFIG_SYS_NS16550_COM4
	(NS16550_t)CONFIG_SYS_NS16550_COM4,
#else
	NULL,
#endif
#ifdef CONFIG_SYS_NS16550_COM5
	(NS16550_t)CONFIG_SYS_NS16550_COM5,
#else
	NULL,
#endif
#ifdef CONFIG_SYS_NS16550_COM6
	(NS16550_t)CONFIG_SYS_NS16550_COM6
#else
	NULL
#endif
};

#define PORT	serial_ports[port-1]

/* Multi serial device functions */
#define DECLARE_ESERIAL_FUNCTIONS(port) \
	static int  eserial##port##_init(void) \
	{ \
		int clock_divisor; \
		clock_divisor = calc_divisor(serial_ports[port-1]); \
		NS16550_init(serial_ports[port-1], clock_divisor); \
		return 0 ; \
	} \
	static void eserial##port##_setbrg(void) \
	{ \
		serial_setbrg_dev(port); \
	} \
	static int  eserial##port##_getc(void) \
	{ \
		return serial_getc_dev(port); \
	} \
	static int  eserial##port##_tstc(void) \
	{ \
		return serial_tstc_dev(port); \
	} \
	static void eserial##port##_putc(const char c) \
	{ \
		serial_putc_dev(port, c); \
	} \
	static void eserial##port##_puts(const char *s) \
	{ \
		serial_puts_dev(port, s); \
	}

/* Serial device descriptor */
#define INIT_ESERIAL_STRUCTURE(port, __name) {	\
	.name	= __name,			\
	.start	= eserial##port##_init,		\
	.stop	= NULL,				\
	.setbrg	= eserial##port##_setbrg,	\
	.getc	= eserial##port##_getc,		\
	.tstc	= eserial##port##_tstc,		\
	.putc	= eserial##port##_putc,		\
	.puts	= eserial##port##_puts,		\
}

static int calc_divisor (NS16550_t port)
{
#ifdef CONFIG_OMAP1510
	/* If can't cleanly clock 115200 set div to 1 */
	if ((CONFIG_SYS_NS16550_CLK == 12000000) && (gd->baudrate == 115200)) {
		port->osc_12m_sel = OSC_12M_SEL;	/* enable 6.5 * divisor */
		return (1);				/* return 1 for base divisor */
	}
	port->osc_12m_sel = 0;			/* clear if previsouly set */
#endif
#ifdef CONFIG_OMAP1610
	/* If can't cleanly clock 115200 set div to 1 */
	if ((CONFIG_SYS_NS16550_CLK == 48000000) && (gd->baudrate == 115200)) {
		return (26);		/* return 26 for base divisor */
	}
#endif

#define MODE_X_DIV 16
	/* Compute divisor value. Normally, we should simply return:
	 *   CONFIG_SYS_NS16550_CLK) / MODE_X_DIV / gd->baudrate
	 * but we need to round that value by adding 0.5.
	 * Rounding is especially important at high baud rates.
	 */
	return (CONFIG_SYS_NS16550_CLK + (gd->baudrate * (MODE_X_DIV / 2))) /
		(MODE_X_DIV * gd->baudrate);
}

void
_serial_putc(const char c,const int port)
{
	if (c == '\n')
		NS16550_putc(PORT, '\r');

	NS16550_putc(PORT, c);
}

void
_serial_putc_raw(const char c,const int port)
{
	NS16550_putc(PORT, c);
}

void
_serial_puts (const char *s,const int port)
{
	while (*s) {
		_serial_putc (*s++,port);
	}
}


int
_serial_getc(const int port)
{
	return NS16550_getc(PORT);
}

int
_serial_tstc(const int port)
{
	return NS16550_tstc(PORT);
}

void
_serial_setbrg (const int port)
{
	int clock_divisor;

	clock_divisor = calc_divisor(PORT);
	NS16550_reinit(PORT, clock_divisor);
}

static inline void
serial_putc_dev(unsigned int dev_index,const char c)
{
	_serial_putc(c,dev_index);
}

static inline void
serial_putc_raw_dev(unsigned int dev_index,const char c)
{
	_serial_putc_raw(c,dev_index);
}

static inline void
serial_puts_dev(unsigned int dev_index,const char *s)
{
	_serial_puts(s,dev_index);
}

static inline int
serial_getc_dev(unsigned int dev_index)
{
	return _serial_getc(dev_index);
}

static inline int
serial_tstc_dev(unsigned int dev_index)
{
	return _serial_tstc(dev_index);
}

static inline void
serial_setbrg_dev(unsigned int dev_index)
{
	_serial_setbrg(dev_index);
}

#if defined(CONFIG_SYS_NS16550_COM1)
DECLARE_ESERIAL_FUNCTIONS(1);
struct serial_device eserial1_device =
	INIT_ESERIAL_STRUCTURE(1, "eserial0");
#endif
#if defined(CONFIG_SYS_NS16550_COM2)
DECLARE_ESERIAL_FUNCTIONS(2);
struct serial_device eserial2_device =
	INIT_ESERIAL_STRUCTURE(2, "eserial1");
#endif
#if defined(CONFIG_SYS_NS16550_COM3)
DECLARE_ESERIAL_FUNCTIONS(3);
struct serial_device eserial3_device =
	INIT_ESERIAL_STRUCTURE(3, "eserial2");
#endif
#if defined(CONFIG_SYS_NS16550_COM4)
DECLARE_ESERIAL_FUNCTIONS(4);
struct serial_device eserial4_device =
	INIT_ESERIAL_STRUCTURE(4, "eserial3");
#endif
#if defined(CONFIG_SYS_NS16550_COM5)
DECLARE_ESERIAL_FUNCTIONS(5);
struct serial_device eserial5_device =
	INIT_ESERIAL_STRUCTURE(5, "eserial4");
#endif
#if defined(CONFIG_SYS_NS16550_COM6)
DECLARE_ESERIAL_FUNCTIONS(6);
struct serial_device eserial6_device =
	INIT_ESERIAL_STRUCTURE(6, "eserial5");
#endif

__weak struct serial_device *default_serial_console(void)
{
#if CONFIG_CONS_INDEX == 1
	return &eserial1_device;
#elif CONFIG_CONS_INDEX == 2
	return &eserial2_device;
#elif CONFIG_CONS_INDEX == 3
	return &eserial3_device;
#elif CONFIG_CONS_INDEX == 4
	return &eserial4_device;
#elif CONFIG_CONS_INDEX == 5
	return &eserial5_device;
#elif CONFIG_CONS_INDEX == 6
	return &eserial6_device;
#else
#error "Bad CONFIG_CONS_INDEX."
#endif
}

void ns16550_serial_initialize(void)
{
#if defined(CONFIG_SYS_NS16550_COM1)
	serial_register(&eserial1_device);
#endif
#if defined(CONFIG_SYS_NS16550_COM2)
	serial_register(&eserial2_device);
#endif
#if defined(CONFIG_SYS_NS16550_COM3)
	serial_register(&eserial3_device);
#endif
#if defined(CONFIG_SYS_NS16550_COM4)
	serial_register(&eserial4_device);
#endif
#if defined(CONFIG_SYS_NS16550_COM5)
	serial_register(&eserial5_device);
#endif
#if defined(CONFIG_SYS_NS16550_COM6)
	serial_register(&eserial6_device);
#endif
}

#endif /* !CONFIG_NS16550_MIN_FUNCTIONS */
Commit	Line	Data
78f6622a WD	1	/*
	2	* (C) Copyright 2000
	3	* Rob Taylor, Flying Pig Systems. robt@flyingpig.com.
	4	*
1a459660	5	* SPDX-License-Identifier: GPL-2.0+
78f6622a WD	6	*/
	7
	8	#include <common.h>
6c768ca7	9	#include <linux/compiler.h>
78f6622a	10
78f6622a	11	#include <ns16550.h>
55d6d2d3	12	#ifdef CONFIG_NS87308
78f6622a WD	13	#include <ns87308.h>
	14	#endif
	15
0fd30252	16	#include <serial.h>
0fd30252	17
48cbc3a8 SW	18	#ifndef CONFIG_NS16550_MIN_FUNCTIONS
48cbc3a8 SW	19
d87080b7 WD	20	DECLARE_GLOBAL_DATA_PTR;
d87080b7 WD	21
756f586a	22	#if !defined(CONFIG_CONS_INDEX)
96708a06	23	#elif (CONFIG_CONS_INDEX < 1) \|\| (CONFIG_CONS_INDEX > 6)
756f586a WD	24	#error "Invalid console index value."
	25	#endif
	26
6d0f6bcf	27	#if CONFIG_CONS_INDEX == 1 && !defined(CONFIG_SYS_NS16550_COM1)
756f586a	28	#error "Console port 1 defined but not configured."
6d0f6bcf	29	#elif CONFIG_CONS_INDEX == 2 && !defined(CONFIG_SYS_NS16550_COM2)
756f586a	30	#error "Console port 2 defined but not configured."
6d0f6bcf	31	#elif CONFIG_CONS_INDEX == 3 && !defined(CONFIG_SYS_NS16550_COM3)
756f586a	32	#error "Console port 3 defined but not configured."
6d0f6bcf	33	#elif CONFIG_CONS_INDEX == 4 && !defined(CONFIG_SYS_NS16550_COM4)
756f586a	34	#error "Console port 4 defined but not configured."
96708a06 AB	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."
756f586a WD	39	#endif
	40
	41	/* Note: The port number specified in the functions is 1 based.
	42	* the array is 0 based.
	43	*/
96708a06	44	static NS16550_t serial_ports[6] = {
6d0f6bcf JCPV	45	#ifdef CONFIG_SYS_NS16550_COM1
6d0f6bcf JCPV	46	(NS16550_t)CONFIG_SYS_NS16550_COM1,
756f586a WD	47	#else
	48	NULL,
	49	#endif
6d0f6bcf JCPV	50	#ifdef CONFIG_SYS_NS16550_COM2
6d0f6bcf JCPV	51	(NS16550_t)CONFIG_SYS_NS16550_COM2,
78f6622a	52	#else
756f586a	53	NULL,
78f6622a	54	#endif
6d0f6bcf JCPV	55	#ifdef CONFIG_SYS_NS16550_COM3
6d0f6bcf JCPV	56	(NS16550_t)CONFIG_SYS_NS16550_COM3,
756f586a WD	57	#else
	58	NULL,
	59	#endif
6d0f6bcf	60	#ifdef CONFIG_SYS_NS16550_COM4
96708a06 AB	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
756f586a WD	72	#else
	73	NULL
	74	#endif
	75	};
	76
	77	#define PORT serial_ports[port-1]
0fd30252	78
0fd30252 WD	79	/* Multi serial device functions */
0fd30252 WD	80	#define DECLARE_ESERIAL_FUNCTIONS(port) \
ac63f2a2 KP	81	static int eserial##port##_init(void) \
	82	{ \
	83	int clock_divisor; \
	84	clock_divisor = calc_divisor(serial_ports[port-1]); \
	85	NS16550_init(serial_ports[port-1], clock_divisor); \
	86	return 0 ; \
	87	} \
	88	static void eserial##port##_setbrg(void) \
	89	{ \
	90	serial_setbrg_dev(port); \
	91	} \
	92	static int eserial##port##_getc(void) \
	93	{ \
	94	return serial_getc_dev(port); \
	95	} \
	96	static int eserial##port##_tstc(void) \
	97	{ \
	98	return serial_tstc_dev(port); \
	99	} \
	100	static void eserial##port##_putc(const char c) \
	101	{ \
	102	serial_putc_dev(port, c); \
	103	} \
	104	static void eserial##port##_puts(const char *s) \
	105	{ \
	106	serial_puts_dev(port, s); \
	107	}
0fd30252 WD	108
0fd30252 WD	109	/* Serial device descriptor */
90bad891 MV	110	#define INIT_ESERIAL_STRUCTURE(port, __name) { \
	111	.name = __name, \
	112	.start = eserial##port##_init, \
	113	.stop = NULL, \
	114	.setbrg = eserial##port##_setbrg, \
	115	.getc = eserial##port##_getc, \
	116	.tstc = eserial##port##_tstc, \
	117	.putc = eserial##port##_putc, \
	118	.puts = eserial##port##_puts, \
	119	}
0fd30252	120
756f586a	121	static int calc_divisor (NS16550_t port)
78f6622a	122	{
2e5983d2 WD	123	#ifdef CONFIG_OMAP1510
2e5983d2 WD	124	/* If can't cleanly clock 115200 set div to 1 */
6d0f6bcf	125	if ((CONFIG_SYS_NS16550_CLK == 12000000) && (gd->baudrate == 115200)) {
756f586a	126	port->osc_12m_sel = OSC_12M_SEL; /* enable 6.5 * divisor */
2e5983d2 WD	127	return (1); /* return 1 for base divisor */
2e5983d2 WD	128	}
756f586a	129	port->osc_12m_sel = 0; /* clear if previsouly set */
6f21347d WD	130	#endif
	131	#ifdef CONFIG_OMAP1610
	132	/* If can't cleanly clock 115200 set div to 1 */
6d0f6bcf	133	if ((CONFIG_SYS_NS16550_CLK == 48000000) && (gd->baudrate == 115200)) {
6f21347d WD	134	return (26); /* return 26 for base divisor */
6f21347d WD	135	}
2e5983d2	136	#endif
8ed96046	137
8ed96046	138	#define MODE_X_DIV 16
89134ea1	139	/* Compute divisor value. Normally, we should simply return:
6d0f6bcf	140	* CONFIG_SYS_NS16550_CLK) / MODE_X_DIV / gd->baudrate
bcab74ba	141	* but we need to round that value by adding 0.5.
89134ea1 HV	142	* Rounding is especially important at high baud rates.
89134ea1 HV	143	*/
6d0f6bcf	144	return (CONFIG_SYS_NS16550_CLK + (gd->baudrate * (MODE_X_DIV / 2))) /
bcab74ba	145	(MODE_X_DIV * gd->baudrate);
2e5983d2	146	}
78f6622a	147
78f6622a	148	void
756f586a	149	_serial_putc(const char c,const int port)
78f6622a WD	150	{
78f6622a WD	151	if (c == '\n')
756f586a	152	NS16550_putc(PORT, '\r');
78f6622a	153
756f586a	154	NS16550_putc(PORT, c);
78f6622a WD	155	}
	156
	157	void
756f586a WD	158	_serial_putc_raw(const char c,const int port)
	159	{
	160	NS16550_putc(PORT, c);
	161	}
	162
	163	void
	164	_serial_puts (const char *s,const int port)
78f6622a WD	165	{
78f6622a WD	166	while (*s) {
756f586a	167	_serial_putc (*s++,port);
78f6622a WD	168	}
	169	}
	170
	171
	172	int
756f586a	173	_serial_getc(const int port)
78f6622a	174	{
756f586a	175	return NS16550_getc(PORT);
78f6622a WD	176	}
	177
	178	int
756f586a	179	_serial_tstc(const int port)
78f6622a	180	{
756f586a	181	return NS16550_tstc(PORT);
78f6622a WD	182	}
	183
	184	void
756f586a	185	_serial_setbrg (const int port)
78f6622a	186	{
2e5983d2	187	int clock_divisor;
78f6622a	188
756f586a WD	189	clock_divisor = calc_divisor(PORT);
	190	NS16550_reinit(PORT, clock_divisor);
	191	}
	192
0fd30252 WD	193	static inline void
	194	serial_putc_dev(unsigned int dev_index,const char c)
	195	{
	196	_serial_putc(c,dev_index);
	197	}
756f586a	198
511d0c72	199	static inline void
0fd30252 WD	200	serial_putc_raw_dev(unsigned int dev_index,const char c)
	201	{
	202	_serial_putc_raw(c,dev_index);
	203	}
756f586a	204
0fd30252 WD	205	static inline void
	206	serial_puts_dev(unsigned int dev_index,const char *s)
	207	{
	208	_serial_puts(s,dev_index);
	209	}
756f586a	210
0fd30252 WD	211	static inline int
	212	serial_getc_dev(unsigned int dev_index)
	213	{
	214	return _serial_getc(dev_index);
	215	}
756f586a	216
0fd30252 WD	217	static inline int
	218	serial_tstc_dev(unsigned int dev_index)
	219	{
	220	return _serial_tstc(dev_index);
	221	}
756f586a	222
0fd30252 WD	223	static inline void
	224	serial_setbrg_dev(unsigned int dev_index)
	225	{
	226	_serial_setbrg(dev_index);
	227	}
0fd30252	228
55db9cca	229	#if defined(CONFIG_SYS_NS16550_COM1)
0fd30252	230	DECLARE_ESERIAL_FUNCTIONS(1);
511d0c72	231	struct serial_device eserial1_device =
1c9a5606	232	INIT_ESERIAL_STRUCTURE(1, "eserial0");
55db9cca SW	233	#endif
55db9cca SW	234	#if defined(CONFIG_SYS_NS16550_COM2)
0fd30252 WD	235	DECLARE_ESERIAL_FUNCTIONS(2);
0fd30252 WD	236	struct serial_device eserial2_device =
1c9a5606	237	INIT_ESERIAL_STRUCTURE(2, "eserial1");
55db9cca SW	238	#endif
55db9cca SW	239	#if defined(CONFIG_SYS_NS16550_COM3)
0fd30252 WD	240	DECLARE_ESERIAL_FUNCTIONS(3);
0fd30252 WD	241	struct serial_device eserial3_device =
1c9a5606	242	INIT_ESERIAL_STRUCTURE(3, "eserial2");
55db9cca SW	243	#endif
55db9cca SW	244	#if defined(CONFIG_SYS_NS16550_COM4)
0fd30252 WD	245	DECLARE_ESERIAL_FUNCTIONS(4);
0fd30252 WD	246	struct serial_device eserial4_device =
1c9a5606	247	INIT_ESERIAL_STRUCTURE(4, "eserial3");
55db9cca SW	248	#endif
55db9cca SW	249	#if defined(CONFIG_SYS_NS16550_COM5)
96708a06 AB	250	DECLARE_ESERIAL_FUNCTIONS(5);
	251	struct serial_device eserial5_device =
	252	INIT_ESERIAL_STRUCTURE(5, "eserial4");
55db9cca SW	253	#endif
55db9cca SW	254	#if defined(CONFIG_SYS_NS16550_COM6)
96708a06 AB	255	DECLARE_ESERIAL_FUNCTIONS(6);
	256	struct serial_device eserial6_device =
	257	INIT_ESERIAL_STRUCTURE(6, "eserial5");
55db9cca	258	#endif
6c768ca7 MF	259
	260	__weak struct serial_device *default_serial_console(void)
	261	{
	262	#if CONFIG_CONS_INDEX == 1
	263	return &eserial1_device;
	264	#elif CONFIG_CONS_INDEX == 2
	265	return &eserial2_device;
	266	#elif CONFIG_CONS_INDEX == 3
	267	return &eserial3_device;
	268	#elif CONFIG_CONS_INDEX == 4
	269	return &eserial4_device;
96708a06 AB	270	#elif CONFIG_CONS_INDEX == 5
	271	return &eserial5_device;
	272	#elif CONFIG_CONS_INDEX == 6
	273	return &eserial6_device;
6c768ca7 MF	274	#else
	275	#error "Bad CONFIG_CONS_INDEX."
	276	#endif
	277	}
	278
abc0ed8d MV	279	void ns16550_serial_initialize(void)
	280	{
	281	#if defined(CONFIG_SYS_NS16550_COM1)
	282	serial_register(&eserial1_device);
	283	#endif
	284	#if defined(CONFIG_SYS_NS16550_COM2)
	285	serial_register(&eserial2_device);
	286	#endif
	287	#if defined(CONFIG_SYS_NS16550_COM3)
	288	serial_register(&eserial3_device);
	289	#endif
	290	#if defined(CONFIG_SYS_NS16550_COM4)
	291	serial_register(&eserial4_device);
	292	#endif
96708a06 AB	293	#if defined(CONFIG_SYS_NS16550_COM5)
	294	serial_register(&eserial5_device);
	295	#endif
	296	#if defined(CONFIG_SYS_NS16550_COM6)
	297	serial_register(&eserial6_device);
	298	#endif
abc0ed8d	299	}
48cbc3a8 SW	300
48cbc3a8 SW	301	#endif /* !CONFIG_NS16550_MIN_FUNCTIONS */