1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * altera_jtaguart.c -- Altera JTAG UART driver
4  *
5  * Based on mcf.c -- Freescale ColdFire UART driver
6  *
7  * (C) Copyright 2003-2007, Greg Ungerer <gerg@snapgear.com>
8  * (C) Copyright 2008, Thomas Chou <thomas@wytron.com.tw>
9  * (C) Copyright 2010, Tobias Klauser <tklauser@distanz.ch>
10  */
11 
12 #include <linux/bitfield.h>
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16 #include <linux/module.h>
17 #include <linux/console.h>
18 #include <linux/of.h>
19 #include <linux/tty.h>
20 #include <linux/tty_flip.h>
21 #include <linux/serial.h>
22 #include <linux/serial_core.h>
23 #include <linux/platform_device.h>
24 #include <linux/io.h>
25 #include <linux/altera_jtaguart.h>
26 
27 #define DRV_NAME "altera_jtaguart"
28 
29 /*
30  * Altera JTAG UART register definitions according to the Altera JTAG UART
31  * datasheet: https://www.altera.com/literature/hb/nios2/n2cpu_nii51009.pdf
32  */
33 
34 #define ALTERA_JTAGUART_SIZE			8
35 
36 #define ALTERA_JTAGUART_DATA_REG		0
37 
38 #define ALTERA_JTAGUART_DATA_DATA_MSK		0x000000FF
39 #define ALTERA_JTAGUART_DATA_RVALID_MSK		0x00008000
40 #define ALTERA_JTAGUART_DATA_RAVAIL_MSK		0xFFFF0000
41 #define ALTERA_JTAGUART_DATA_RAVAIL_OFF		16
42 
43 #define ALTERA_JTAGUART_CONTROL_REG		4
44 
45 #define ALTERA_JTAGUART_CONTROL_RE_MSK		0x00000001
46 #define ALTERA_JTAGUART_CONTROL_WE_MSK		0x00000002
47 #define ALTERA_JTAGUART_CONTROL_RI_MSK		0x00000100
48 #define ALTERA_JTAGUART_CONTROL_RI_OFF		8
49 #define ALTERA_JTAGUART_CONTROL_WI_MSK		0x00000200
50 #define ALTERA_JTAGUART_CONTROL_AC_MSK		0x00000400
51 #define ALTERA_JTAGUART_CONTROL_WSPACE_MSK	0xFFFF0000
52 
altera_jtaguart_tx_space(struct uart_port * port,u32 * ctlp)53 static unsigned int altera_jtaguart_tx_space(struct uart_port *port, u32 *ctlp)
54 {
55 	u32 ctl = readl(port->membase + ALTERA_JTAGUART_CONTROL_REG);
56 
57 	if (ctlp)
58 		*ctlp = ctl;
59 
60 	return FIELD_GET(ALTERA_JTAGUART_CONTROL_WSPACE_MSK, ctl);
61 }
62 
altera_jtaguart_tx_empty(struct uart_port * port)63 static unsigned int altera_jtaguart_tx_empty(struct uart_port *port)
64 {
65 	return altera_jtaguart_tx_space(port, NULL) ? TIOCSER_TEMT : 0;
66 }
67 
altera_jtaguart_get_mctrl(struct uart_port * port)68 static unsigned int altera_jtaguart_get_mctrl(struct uart_port *port)
69 {
70 	return TIOCM_CAR | TIOCM_DSR | TIOCM_CTS;
71 }
72 
altera_jtaguart_set_mctrl(struct uart_port * port,unsigned int sigs)73 static void altera_jtaguart_set_mctrl(struct uart_port *port, unsigned int sigs)
74 {
75 }
76 
altera_jtaguart_start_tx(struct uart_port * port)77 static void altera_jtaguart_start_tx(struct uart_port *port)
78 {
79 	port->read_status_mask |= ALTERA_JTAGUART_CONTROL_WE_MSK;
80 	writel(port->read_status_mask,
81 			port->membase + ALTERA_JTAGUART_CONTROL_REG);
82 }
83 
altera_jtaguart_stop_tx(struct uart_port * port)84 static void altera_jtaguart_stop_tx(struct uart_port *port)
85 {
86 	port->read_status_mask &= ~ALTERA_JTAGUART_CONTROL_WE_MSK;
87 	writel(port->read_status_mask,
88 			port->membase + ALTERA_JTAGUART_CONTROL_REG);
89 }
90 
altera_jtaguart_stop_rx(struct uart_port * port)91 static void altera_jtaguart_stop_rx(struct uart_port *port)
92 {
93 	port->read_status_mask &= ~ALTERA_JTAGUART_CONTROL_RE_MSK;
94 	writel(port->read_status_mask,
95 			port->membase + ALTERA_JTAGUART_CONTROL_REG);
96 }
97 
altera_jtaguart_break_ctl(struct uart_port * port,int break_state)98 static void altera_jtaguart_break_ctl(struct uart_port *port, int break_state)
99 {
100 }
101 
altera_jtaguart_set_termios(struct uart_port * port,struct ktermios * termios,const struct ktermios * old)102 static void altera_jtaguart_set_termios(struct uart_port *port,
103 				        struct ktermios *termios,
104 				        const struct ktermios *old)
105 {
106 	/* Just copy the old termios settings back */
107 	if (old)
108 		tty_termios_copy_hw(termios, old);
109 }
110 
altera_jtaguart_rx_chars(struct uart_port * port)111 static void altera_jtaguart_rx_chars(struct uart_port *port)
112 {
113 	u32 status;
114 	u8 ch;
115 
116 	while ((status = readl(port->membase + ALTERA_JTAGUART_DATA_REG)) &
117 	       ALTERA_JTAGUART_DATA_RVALID_MSK) {
118 		ch = status & ALTERA_JTAGUART_DATA_DATA_MSK;
119 		port->icount.rx++;
120 
121 		if (uart_handle_sysrq_char(port, ch))
122 			continue;
123 		uart_insert_char(port, 0, 0, ch, TTY_NORMAL);
124 	}
125 
126 	tty_flip_buffer_push(&port->state->port);
127 }
128 
altera_jtaguart_tx_chars(struct uart_port * port)129 static void altera_jtaguart_tx_chars(struct uart_port *port)
130 {
131 	unsigned int count;
132 	u8 ch;
133 
134 	count = altera_jtaguart_tx_space(port, NULL);
135 
136 	uart_port_tx_limited(port, ch, count,
137 		true,
138 		writel(ch, port->membase + ALTERA_JTAGUART_DATA_REG),
139 		({}));
140 }
141 
altera_jtaguart_interrupt(int irq,void * data)142 static irqreturn_t altera_jtaguart_interrupt(int irq, void *data)
143 {
144 	struct uart_port *port = data;
145 	unsigned int isr;
146 
147 	isr = (readl(port->membase + ALTERA_JTAGUART_CONTROL_REG) >>
148 	       ALTERA_JTAGUART_CONTROL_RI_OFF) & port->read_status_mask;
149 
150 	uart_port_lock(port);
151 
152 	if (isr & ALTERA_JTAGUART_CONTROL_RE_MSK)
153 		altera_jtaguart_rx_chars(port);
154 	if (isr & ALTERA_JTAGUART_CONTROL_WE_MSK)
155 		altera_jtaguart_tx_chars(port);
156 
157 	uart_port_unlock(port);
158 
159 	return IRQ_RETVAL(isr);
160 }
161 
altera_jtaguart_config_port(struct uart_port * port,int flags)162 static void altera_jtaguart_config_port(struct uart_port *port, int flags)
163 {
164 	port->type = PORT_ALTERA_JTAGUART;
165 
166 	/* Clear mask, so no surprise interrupts. */
167 	writel(0, port->membase + ALTERA_JTAGUART_CONTROL_REG);
168 }
169 
altera_jtaguart_startup(struct uart_port * port)170 static int altera_jtaguart_startup(struct uart_port *port)
171 {
172 	unsigned long flags;
173 	int ret;
174 
175 	ret = request_irq(port->irq, altera_jtaguart_interrupt, 0,
176 			DRV_NAME, port);
177 	if (ret) {
178 		pr_err(DRV_NAME ": unable to attach Altera JTAG UART %d "
179 		       "interrupt vector=%d\n", port->line, port->irq);
180 		return ret;
181 	}
182 
183 	uart_port_lock_irqsave(port, &flags);
184 
185 	/* Enable RX interrupts now */
186 	port->read_status_mask = ALTERA_JTAGUART_CONTROL_RE_MSK;
187 	writel(port->read_status_mask,
188 			port->membase + ALTERA_JTAGUART_CONTROL_REG);
189 
190 	uart_port_unlock_irqrestore(port, flags);
191 
192 	return 0;
193 }
194 
altera_jtaguart_shutdown(struct uart_port * port)195 static void altera_jtaguart_shutdown(struct uart_port *port)
196 {
197 	unsigned long flags;
198 
199 	uart_port_lock_irqsave(port, &flags);
200 
201 	/* Disable all interrupts now */
202 	port->read_status_mask = 0;
203 	writel(port->read_status_mask,
204 			port->membase + ALTERA_JTAGUART_CONTROL_REG);
205 
206 	uart_port_unlock_irqrestore(port, flags);
207 
208 	free_irq(port->irq, port);
209 }
210 
altera_jtaguart_type(struct uart_port * port)211 static const char *altera_jtaguart_type(struct uart_port *port)
212 {
213 	return (port->type == PORT_ALTERA_JTAGUART) ? "Altera JTAG UART" : NULL;
214 }
215 
altera_jtaguart_request_port(struct uart_port * port)216 static int altera_jtaguart_request_port(struct uart_port *port)
217 {
218 	/* UARTs always present */
219 	return 0;
220 }
221 
altera_jtaguart_release_port(struct uart_port * port)222 static void altera_jtaguart_release_port(struct uart_port *port)
223 {
224 	/* Nothing to release... */
225 }
226 
altera_jtaguart_verify_port(struct uart_port * port,struct serial_struct * ser)227 static int altera_jtaguart_verify_port(struct uart_port *port,
228 				       struct serial_struct *ser)
229 {
230 	if (ser->type != PORT_UNKNOWN && ser->type != PORT_ALTERA_JTAGUART)
231 		return -EINVAL;
232 	return 0;
233 }
234 
235 /*
236  *	Define the basic serial functions we support.
237  */
238 static const struct uart_ops altera_jtaguart_ops = {
239 	.tx_empty	= altera_jtaguart_tx_empty,
240 	.get_mctrl	= altera_jtaguart_get_mctrl,
241 	.set_mctrl	= altera_jtaguart_set_mctrl,
242 	.start_tx	= altera_jtaguart_start_tx,
243 	.stop_tx	= altera_jtaguart_stop_tx,
244 	.stop_rx	= altera_jtaguart_stop_rx,
245 	.break_ctl	= altera_jtaguart_break_ctl,
246 	.startup	= altera_jtaguart_startup,
247 	.shutdown	= altera_jtaguart_shutdown,
248 	.set_termios	= altera_jtaguart_set_termios,
249 	.type		= altera_jtaguart_type,
250 	.request_port	= altera_jtaguart_request_port,
251 	.release_port	= altera_jtaguart_release_port,
252 	.config_port	= altera_jtaguart_config_port,
253 	.verify_port	= altera_jtaguart_verify_port,
254 };
255 
256 #define ALTERA_JTAGUART_MAXPORTS 1
257 static struct uart_port altera_jtaguart_ports[ALTERA_JTAGUART_MAXPORTS];
258 
259 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE)
260 
261 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE_BYPASS)
altera_jtaguart_console_putc(struct uart_port * port,unsigned char c)262 static void altera_jtaguart_console_putc(struct uart_port *port, unsigned char c)
263 {
264 	unsigned long flags;
265 	u32 status;
266 
267 	uart_port_lock_irqsave(port, &flags);
268 	while (!altera_jtaguart_tx_space(port, &status)) {
269 		uart_port_unlock_irqrestore(port, flags);
270 
271 		if ((status & ALTERA_JTAGUART_CONTROL_AC_MSK) == 0) {
272 			return;	/* no connection activity */
273 		}
274 
275 		cpu_relax();
276 		uart_port_lock_irqsave(port, &flags);
277 	}
278 	writel(c, port->membase + ALTERA_JTAGUART_DATA_REG);
279 	uart_port_unlock_irqrestore(port, flags);
280 }
281 #else
altera_jtaguart_console_putc(struct uart_port * port,unsigned char c)282 static void altera_jtaguart_console_putc(struct uart_port *port, unsigned char c)
283 {
284 	unsigned long flags;
285 
286 	uart_port_lock_irqsave(port, &flags);
287 	while (!altera_jtaguart_tx_space(port, NULL)) {
288 		uart_port_unlock_irqrestore(port, flags);
289 		cpu_relax();
290 		uart_port_lock_irqsave(port, &flags);
291 	}
292 	writel(c, port->membase + ALTERA_JTAGUART_DATA_REG);
293 	uart_port_unlock_irqrestore(port, flags);
294 }
295 #endif
296 
altera_jtaguart_console_write(struct console * co,const char * s,unsigned int count)297 static void altera_jtaguart_console_write(struct console *co, const char *s,
298 					  unsigned int count)
299 {
300 	struct uart_port *port = &altera_jtaguart_ports[co->index];
301 
302 	uart_console_write(port, s, count, altera_jtaguart_console_putc);
303 }
304 
altera_jtaguart_console_setup(struct console * co,char * options)305 static int __init altera_jtaguart_console_setup(struct console *co,
306 						char *options)
307 {
308 	struct uart_port *port;
309 
310 	if (co->index < 0 || co->index >= ALTERA_JTAGUART_MAXPORTS)
311 		return -EINVAL;
312 	port = &altera_jtaguart_ports[co->index];
313 	if (port->membase == NULL)
314 		return -ENODEV;
315 	return 0;
316 }
317 
318 static struct uart_driver altera_jtaguart_driver;
319 
320 static struct console altera_jtaguart_console = {
321 	.name	= "ttyJ",
322 	.write	= altera_jtaguart_console_write,
323 	.device	= uart_console_device,
324 	.setup	= altera_jtaguart_console_setup,
325 	.flags	= CON_PRINTBUFFER,
326 	.index	= -1,
327 	.data	= &altera_jtaguart_driver,
328 };
329 
altera_jtaguart_console_init(void)330 static int __init altera_jtaguart_console_init(void)
331 {
332 	register_console(&altera_jtaguart_console);
333 	return 0;
334 }
335 
336 console_initcall(altera_jtaguart_console_init);
337 
338 #define	ALTERA_JTAGUART_CONSOLE	(&altera_jtaguart_console)
339 
altera_jtaguart_earlycon_write(struct console * co,const char * s,unsigned int count)340 static void altera_jtaguart_earlycon_write(struct console *co, const char *s,
341 					   unsigned int count)
342 {
343 	struct earlycon_device *dev = co->data;
344 
345 	uart_console_write(&dev->port, s, count, altera_jtaguart_console_putc);
346 }
347 
altera_jtaguart_earlycon_setup(struct earlycon_device * dev,const char * options)348 static int __init altera_jtaguart_earlycon_setup(struct earlycon_device *dev,
349 						 const char *options)
350 {
351 	if (!dev->port.membase)
352 		return -ENODEV;
353 
354 	dev->con->write = altera_jtaguart_earlycon_write;
355 	return 0;
356 }
357 
358 OF_EARLYCON_DECLARE(juart, "altr,juart-1.0", altera_jtaguart_earlycon_setup);
359 
360 #else
361 
362 #define	ALTERA_JTAGUART_CONSOLE	NULL
363 
364 #endif /* CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE */
365 
366 static struct uart_driver altera_jtaguart_driver = {
367 	.owner		= THIS_MODULE,
368 	.driver_name	= "altera_jtaguart",
369 	.dev_name	= "ttyJ",
370 	.major		= ALTERA_JTAGUART_MAJOR,
371 	.minor		= ALTERA_JTAGUART_MINOR,
372 	.nr		= ALTERA_JTAGUART_MAXPORTS,
373 	.cons		= ALTERA_JTAGUART_CONSOLE,
374 };
375 
altera_jtaguart_probe(struct platform_device * pdev)376 static int altera_jtaguart_probe(struct platform_device *pdev)
377 {
378 	struct altera_jtaguart_platform_uart *platp =
379 			dev_get_platdata(&pdev->dev);
380 	struct uart_port *port;
381 	struct resource *res_mem;
382 	int i = pdev->id;
383 	int irq;
384 
385 	/* -1 emphasizes that the platform must have one port, no .N suffix */
386 	if (i == -1)
387 		i = 0;
388 
389 	if (i >= ALTERA_JTAGUART_MAXPORTS)
390 		return -EINVAL;
391 
392 	port = &altera_jtaguart_ports[i];
393 
394 	res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
395 	if (res_mem)
396 		port->mapbase = res_mem->start;
397 	else if (platp)
398 		port->mapbase = platp->mapbase;
399 	else
400 		return -ENODEV;
401 
402 	irq = platform_get_irq_optional(pdev, 0);
403 	if (irq < 0 && irq != -ENXIO)
404 		return irq;
405 	if (irq > 0)
406 		port->irq = irq;
407 	else if (platp)
408 		port->irq = platp->irq;
409 	else
410 		return -ENODEV;
411 
412 	port->membase = ioremap(port->mapbase, ALTERA_JTAGUART_SIZE);
413 	if (!port->membase)
414 		return -ENOMEM;
415 
416 	port->line = i;
417 	port->type = PORT_ALTERA_JTAGUART;
418 	port->iotype = SERIAL_IO_MEM;
419 	port->ops = &altera_jtaguart_ops;
420 	port->flags = UPF_BOOT_AUTOCONF;
421 	port->dev = &pdev->dev;
422 
423 	uart_add_one_port(&altera_jtaguart_driver, port);
424 
425 	return 0;
426 }
427 
altera_jtaguart_remove(struct platform_device * pdev)428 static void altera_jtaguart_remove(struct platform_device *pdev)
429 {
430 	struct uart_port *port;
431 	int i = pdev->id;
432 
433 	if (i == -1)
434 		i = 0;
435 
436 	port = &altera_jtaguart_ports[i];
437 	uart_remove_one_port(&altera_jtaguart_driver, port);
438 	iounmap(port->membase);
439 }
440 
441 #ifdef CONFIG_OF
442 static const struct of_device_id altera_jtaguart_match[] = {
443 	{ .compatible = "ALTR,juart-1.0", },
444 	{ .compatible = "altr,juart-1.0", },
445 	{},
446 };
447 MODULE_DEVICE_TABLE(of, altera_jtaguart_match);
448 #endif /* CONFIG_OF */
449 
450 static struct platform_driver altera_jtaguart_platform_driver = {
451 	.probe	= altera_jtaguart_probe,
452 	.remove_new = altera_jtaguart_remove,
453 	.driver	= {
454 		.name		= DRV_NAME,
455 		.of_match_table	= of_match_ptr(altera_jtaguart_match),
456 	},
457 };
458 
altera_jtaguart_init(void)459 static int __init altera_jtaguart_init(void)
460 {
461 	int rc;
462 
463 	rc = uart_register_driver(&altera_jtaguart_driver);
464 	if (rc)
465 		return rc;
466 	rc = platform_driver_register(&altera_jtaguart_platform_driver);
467 	if (rc)
468 		uart_unregister_driver(&altera_jtaguart_driver);
469 	return rc;
470 }
471 
altera_jtaguart_exit(void)472 static void __exit altera_jtaguart_exit(void)
473 {
474 	platform_driver_unregister(&altera_jtaguart_platform_driver);
475 	uart_unregister_driver(&altera_jtaguart_driver);
476 }
477 
478 module_init(altera_jtaguart_init);
479 module_exit(altera_jtaguart_exit);
480 
481 MODULE_DESCRIPTION("Altera JTAG UART driver");
482 MODULE_AUTHOR("Thomas Chou <thomas@wytron.com.tw>");
483 MODULE_LICENSE("GPL");
484 MODULE_ALIAS("platform:" DRV_NAME);
485