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