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))
10 static 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)
23 static void *uartbase;
24 
25 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE_BYPASS)
26 static 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
33 static 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 
42 static int putchar(int ch)
43 {
44 	jtag_putc(ch);
45 	return ch;
46 }
47 
48 static 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)
62 static unsigned uartbase;
63 
64 static 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 
76 static int putchar(int ch)
77 {
78 	uart_putc(ch);
79 	if (ch == '\n')
80 		uart_putc('\r');
81 	return ch;
82 }
83 
84 static 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 
96 static int putchar(int ch)
97 {
98 	return ch;
99 }
100 
101 static void console_init(void)
102 {
103 }
104 
105 #endif
106 
107 static int puts(const char *s)
108 {
109 	while (*s)
110 		putchar(*s++);
111 	return 0;
112 }
113