1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 *  Copyright (C) 2008-2010 Thomas Chou <thomas@wytron.com.tw>
4 */
5
6#include <linux/io.h>
7
8#if (defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE) && defined(JTAG_UART_BASE))\
9	|| (defined(CONFIG_SERIAL_ALTERA_UART_CONSOLE) && defined(UART0_BASE))
10static void *my_ioremap(unsigned long physaddr)
11{
12	return (void *)(physaddr | CONFIG_NIOS2_IO_REGION_BASE);
13}
14#endif
15
16#if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE) && defined(JTAG_UART_BASE)
17
18#define ALTERA_JTAGUART_SIZE				8
19#define ALTERA_JTAGUART_DATA_REG			0
20#define ALTERA_JTAGUART_CONTROL_REG			4
21#define ALTERA_JTAGUART_CONTROL_AC_MSK			(0x00000400)
22#define ALTERA_JTAGUART_CONTROL_WSPACE_MSK		(0xFFFF0000)
23static void *uartbase;
24
25#if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE_BYPASS)
26static void jtag_putc(int ch)
27{
28	if (readl(uartbase + ALTERA_JTAGUART_CONTROL_REG) &
29		ALTERA_JTAGUART_CONTROL_WSPACE_MSK)
30		writeb(ch, uartbase + ALTERA_JTAGUART_DATA_REG);
31}
32#else
33static void jtag_putc(int ch)
34{
35	while ((readl(uartbase + ALTERA_JTAGUART_CONTROL_REG) &
36		ALTERA_JTAGUART_CONTROL_WSPACE_MSK) == 0)
37		;
38	writeb(ch, uartbase + ALTERA_JTAGUART_DATA_REG);
39}
40#endif
41
42static int putchar(int ch)
43{
44	jtag_putc(ch);
45	return ch;
46}
47
48static void console_init(void)
49{
50	uartbase = my_ioremap((unsigned long) JTAG_UART_BASE);
51	writel(ALTERA_JTAGUART_CONTROL_AC_MSK,
52		uartbase + ALTERA_JTAGUART_CONTROL_REG);
53}
54
55#elif defined(CONFIG_SERIAL_ALTERA_UART_CONSOLE) && defined(UART0_BASE)
56
57#define ALTERA_UART_SIZE		32
58#define ALTERA_UART_TXDATA_REG		4
59#define ALTERA_UART_STATUS_REG		8
60#define ALTERA_UART_DIVISOR_REG		16
61#define ALTERA_UART_STATUS_TRDY_MSK	(0x40)
62static unsigned uartbase;
63
64static void uart_putc(int ch)
65{
66	int i;
67
68	for (i = 0; (i < 0x10000); i++) {
69		if (readw(uartbase + ALTERA_UART_STATUS_REG) &
70			ALTERA_UART_STATUS_TRDY_MSK)
71			break;
72	}
73	writeb(ch, uartbase + ALTERA_UART_TXDATA_REG);
74}
75
76static int putchar(int ch)
77{
78	uart_putc(ch);
79	if (ch == '\n')
80		uart_putc('\r');
81	return ch;
82}
83
84static void console_init(void)
85{
86	unsigned int baud, baudclk;
87
88	uartbase = (unsigned long) my_ioremap((unsigned long) UART0_BASE);
89	baud = CONFIG_SERIAL_ALTERA_UART_BAUDRATE;
90	baudclk = UART0_FREQ / baud;
91	writew(baudclk, uartbase + ALTERA_UART_DIVISOR_REG);
92}
93
94#else
95
96static int putchar(int ch)
97{
98	return ch;
99}
100
101static void console_init(void)
102{
103}
104
105#endif
106
107static int puts(const char *s)
108{
109	while (*s)
110		putchar(*s++);
111	return 0;
112}
113