163 lines
		
	
	
		
			4.2 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			163 lines
		
	
	
		
			4.2 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * (C) Copyright 2008-2011 Michal Simek <monstr@monstr.eu>
 | 
						|
 * Clean driver and add xilinx constant from header file
 | 
						|
 *
 | 
						|
 * (C) Copyright 2004 Atmark Techno, Inc.
 | 
						|
 * Yasushi SHOJI <yashi@atmark-techno.com>
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier:	GPL-2.0+
 | 
						|
 */
 | 
						|
 | 
						|
#include <config.h>
 | 
						|
#include <common.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <linux/compiler.h>
 | 
						|
#include <serial.h>
 | 
						|
 | 
						|
#define SR_TX_FIFO_FULL		0x08 /* transmit FIFO full */
 | 
						|
#define SR_RX_FIFO_VALID_DATA	0x01 /* data in receive FIFO */
 | 
						|
#define SR_RX_FIFO_FULL		0x02 /* receive FIFO full */
 | 
						|
 | 
						|
#define ULITE_CONTROL_RST_TX	0x01
 | 
						|
#define ULITE_CONTROL_RST_RX	0x02
 | 
						|
 | 
						|
struct uartlite {
 | 
						|
	unsigned int rx_fifo;
 | 
						|
	unsigned int tx_fifo;
 | 
						|
	unsigned int status;
 | 
						|
	unsigned int control;
 | 
						|
};
 | 
						|
 | 
						|
static struct uartlite *userial_ports[4] = {
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR
 | 
						|
	[0] = (struct uartlite *)XILINX_UARTLITE_BASEADDR,
 | 
						|
#endif
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR1
 | 
						|
	[1] = (struct uartlite *)XILINX_UARTLITE_BASEADDR1,
 | 
						|
#endif
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR2
 | 
						|
	[2] = (struct uartlite *)XILINX_UARTLITE_BASEADDR2,
 | 
						|
#endif
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR3
 | 
						|
	[3] = (struct uartlite *)XILINX_UARTLITE_BASEADDR3
 | 
						|
#endif
 | 
						|
};
 | 
						|
 | 
						|
static void uartlite_serial_putc(const char c, const int port)
 | 
						|
{
 | 
						|
	struct uartlite *regs = userial_ports[port];
 | 
						|
 | 
						|
	if (c == '\n')
 | 
						|
		uartlite_serial_putc('\r', port);
 | 
						|
 | 
						|
	while (in_be32(®s->status) & SR_TX_FIFO_FULL)
 | 
						|
		;
 | 
						|
	out_be32(®s->tx_fifo, c & 0xff);
 | 
						|
}
 | 
						|
 | 
						|
static void uartlite_serial_puts(const char *s, const int port)
 | 
						|
{
 | 
						|
	while (*s)
 | 
						|
		uartlite_serial_putc(*s++, port);
 | 
						|
}
 | 
						|
 | 
						|
static int uartlite_serial_getc(const int port)
 | 
						|
{
 | 
						|
	struct uartlite *regs = userial_ports[port];
 | 
						|
 | 
						|
	while (!(in_be32(®s->status) & SR_RX_FIFO_VALID_DATA))
 | 
						|
		;
 | 
						|
	return in_be32(®s->rx_fifo) & 0xff;
 | 
						|
}
 | 
						|
 | 
						|
static int uartlite_serial_tstc(const int port)
 | 
						|
{
 | 
						|
	struct uartlite *regs = userial_ports[port];
 | 
						|
 | 
						|
	return in_be32(®s->status) & SR_RX_FIFO_VALID_DATA;
 | 
						|
}
 | 
						|
 | 
						|
static int uartlite_serial_init(const int port)
 | 
						|
{
 | 
						|
	struct uartlite *regs = userial_ports[port];
 | 
						|
 | 
						|
	if (regs) {
 | 
						|
		out_be32(®s->control, 0);
 | 
						|
		out_be32(®s->control,
 | 
						|
			 ULITE_CONTROL_RST_RX | ULITE_CONTROL_RST_TX);
 | 
						|
		in_be32(®s->control);
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
 | 
						|
	return -1;
 | 
						|
}
 | 
						|
 | 
						|
/* Multi serial device functions */
 | 
						|
#define DECLARE_ESERIAL_FUNCTIONS(port) \
 | 
						|
	static int userial##port##_init(void) \
 | 
						|
				{ return uartlite_serial_init(port); } \
 | 
						|
	static void userial##port##_setbrg(void) {} \
 | 
						|
	static int userial##port##_getc(void) \
 | 
						|
				{ return uartlite_serial_getc(port); } \
 | 
						|
	static int userial##port##_tstc(void) \
 | 
						|
				{ return uartlite_serial_tstc(port); } \
 | 
						|
	static void userial##port##_putc(const char c) \
 | 
						|
				{ uartlite_serial_putc(c, port); } \
 | 
						|
	static void userial##port##_puts(const char *s) \
 | 
						|
				{ uartlite_serial_puts(s, port); }
 | 
						|
 | 
						|
/* Serial device descriptor */
 | 
						|
#define INIT_ESERIAL_STRUCTURE(port, __name) {	\
 | 
						|
	.name	= __name,			\
 | 
						|
	.start	= userial##port##_init,		\
 | 
						|
	.stop	= NULL,				\
 | 
						|
	.setbrg	= userial##port##_setbrg,	\
 | 
						|
	.getc	= userial##port##_getc,		\
 | 
						|
	.tstc	= userial##port##_tstc,		\
 | 
						|
	.putc	= userial##port##_putc,		\
 | 
						|
	.puts	= userial##port##_puts,		\
 | 
						|
}
 | 
						|
 | 
						|
DECLARE_ESERIAL_FUNCTIONS(0);
 | 
						|
struct serial_device uartlite_serial0_device =
 | 
						|
	INIT_ESERIAL_STRUCTURE(0, "ttyUL0");
 | 
						|
DECLARE_ESERIAL_FUNCTIONS(1);
 | 
						|
struct serial_device uartlite_serial1_device =
 | 
						|
	INIT_ESERIAL_STRUCTURE(1, "ttyUL1");
 | 
						|
DECLARE_ESERIAL_FUNCTIONS(2);
 | 
						|
struct serial_device uartlite_serial2_device =
 | 
						|
	INIT_ESERIAL_STRUCTURE(2, "ttyUL2");
 | 
						|
DECLARE_ESERIAL_FUNCTIONS(3);
 | 
						|
struct serial_device uartlite_serial3_device =
 | 
						|
	INIT_ESERIAL_STRUCTURE(3, "ttyUL3");
 | 
						|
 | 
						|
__weak struct serial_device *default_serial_console(void)
 | 
						|
{
 | 
						|
	if (userial_ports[0])
 | 
						|
		return &uartlite_serial0_device;
 | 
						|
	if (userial_ports[1])
 | 
						|
		return &uartlite_serial1_device;
 | 
						|
	if (userial_ports[2])
 | 
						|
		return &uartlite_serial2_device;
 | 
						|
	if (userial_ports[3])
 | 
						|
		return &uartlite_serial3_device;
 | 
						|
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
 | 
						|
void uartlite_serial_initialize(void)
 | 
						|
{
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR
 | 
						|
	serial_register(&uartlite_serial0_device);
 | 
						|
#endif /* XILINX_UARTLITE_BASEADDR */
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR1
 | 
						|
	serial_register(&uartlite_serial1_device);
 | 
						|
#endif /* XILINX_UARTLITE_BASEADDR1 */
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR2
 | 
						|
	serial_register(&uartlite_serial2_device);
 | 
						|
#endif /* XILINX_UARTLITE_BASEADDR2 */
 | 
						|
#ifdef XILINX_UARTLITE_BASEADDR3
 | 
						|
	serial_register(&uartlite_serial3_device);
 | 
						|
#endif /* XILINX_UARTLITE_BASEADDR3 */
 | 
						|
}
 |