1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/module.h>
20#include <linux/ioport.h>
21#include <linux/init.h>
22#include <linux/serial.h>
23#include <linux/tty.h>
24#include <linux/tty_flip.h>
25#include <linux/console.h>
26#include <linux/delay.h>
27#include <linux/device.h>
28#include <asm/io.h>
29#include <asm/irq.h>
30#include <asm/parisc-device.h>
31
32#if defined(CONFIG_SERIAL_MUX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
33#include <linux/sysrq.h>
34#define SUPPORT_SYSRQ
35#endif
36
37#include <linux/serial_core.h>
38
39#define MUX_OFFSET 0x800
40#define MUX_LINE_OFFSET 0x80
41
42#define MUX_FIFO_SIZE 255
43#define MUX_POLL_DELAY (30 * HZ / 1000)
44
45#define IO_DATA_REG_OFFSET 0x3c
46#define IO_DCOUNT_REG_OFFSET 0x40
47
48#define MUX_EOFIFO(status) ((status & 0xF000) == 0xF000)
49#define MUX_STATUS(status) ((status & 0xF000) == 0x8000)
50#define MUX_BREAK(status) ((status & 0xF000) == 0x2000)
51
52#define MUX_NR 256
53static unsigned int port_cnt __read_mostly;
54struct mux_port {
55 struct uart_port port;
56 int enabled;
57};
58static struct mux_port mux_ports[MUX_NR];
59
60static struct uart_driver mux_driver = {
61 .owner = THIS_MODULE,
62 .driver_name = "ttyB",
63 .dev_name = "ttyB",
64 .major = MUX_MAJOR,
65 .minor = 0,
66 .nr = MUX_NR,
67};
68
69static struct timer_list mux_timer;
70
71#define UART_PUT_CHAR(p, c) __raw_writel((c), (p)->membase + IO_DATA_REG_OFFSET)
72#define UART_GET_FIFO_CNT(p) __raw_readl((p)->membase + IO_DCOUNT_REG_OFFSET)
73
74
75
76
77
78
79
80
81
82
83
84static int __init get_mux_port_count(struct parisc_device *dev)
85{
86 int status;
87 u8 iodc_data[32];
88 unsigned long bytecnt;
89
90
91
92
93
94 if(dev->id.hversion == 0x15)
95 return 1;
96
97 status = pdc_iodc_read(&bytecnt, dev->hpa.start, 0, iodc_data, 32);
98 BUG_ON(status != PDC_OK);
99
100
101 return ((((iodc_data)[4] & 0xf0) >> 4) * 8) + 8;
102}
103
104
105
106
107
108
109
110
111
112static unsigned int mux_tx_empty(struct uart_port *port)
113{
114 return UART_GET_FIFO_CNT(port) ? 0 : TIOCSER_TEMT;
115}
116
117
118
119
120
121
122
123
124
125static void mux_set_mctrl(struct uart_port *port, unsigned int mctrl)
126{
127}
128
129
130
131
132
133
134
135
136static unsigned int mux_get_mctrl(struct uart_port *port)
137{
138 return TIOCM_CAR | TIOCM_DSR | TIOCM_CTS;
139}
140
141
142
143
144
145
146
147static void mux_stop_tx(struct uart_port *port)
148{
149}
150
151
152
153
154
155
156
157static void mux_start_tx(struct uart_port *port)
158{
159}
160
161
162
163
164
165
166
167static void mux_stop_rx(struct uart_port *port)
168{
169}
170
171
172
173
174
175
176
177
178static void mux_break_ctl(struct uart_port *port, int break_state)
179{
180}
181
182
183
184
185
186
187
188
189static void mux_write(struct uart_port *port)
190{
191 int count;
192 struct circ_buf *xmit = &port->state->xmit;
193
194 if(port->x_char) {
195 UART_PUT_CHAR(port, port->x_char);
196 port->icount.tx++;
197 port->x_char = 0;
198 return;
199 }
200
201 if(uart_circ_empty(xmit) || uart_tx_stopped(port)) {
202 mux_stop_tx(port);
203 return;
204 }
205
206 count = (port->fifosize) - UART_GET_FIFO_CNT(port);
207 do {
208 UART_PUT_CHAR(port, xmit->buf[xmit->tail]);
209 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
210 port->icount.tx++;
211 if(uart_circ_empty(xmit))
212 break;
213
214 } while(--count > 0);
215
216 while(UART_GET_FIFO_CNT(port))
217 udelay(1);
218
219 if(uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
220 uart_write_wakeup(port);
221
222 if (uart_circ_empty(xmit))
223 mux_stop_tx(port);
224}
225
226
227
228
229
230
231
232
233static void mux_read(struct uart_port *port)
234{
235 struct tty_port *tport = &port->state->port;
236 int data;
237 __u32 start_count = port->icount.rx;
238
239 while(1) {
240 data = __raw_readl(port->membase + IO_DATA_REG_OFFSET);
241
242 if (MUX_STATUS(data))
243 continue;
244
245 if (MUX_EOFIFO(data))
246 break;
247
248 port->icount.rx++;
249
250 if (MUX_BREAK(data)) {
251 port->icount.brk++;
252 if(uart_handle_break(port))
253 continue;
254 }
255
256 if (uart_handle_sysrq_char(port, data & 0xffu))
257 continue;
258
259 tty_insert_flip_char(tport, data & 0xFF, TTY_NORMAL);
260 }
261
262 if (start_count != port->icount.rx)
263 tty_flip_buffer_push(tport);
264}
265
266
267
268
269
270
271
272
273static int mux_startup(struct uart_port *port)
274{
275 mux_ports[port->line].enabled = 1;
276 return 0;
277}
278
279
280
281
282
283
284
285static void mux_shutdown(struct uart_port *port)
286{
287 mux_ports[port->line].enabled = 0;
288}
289
290
291
292
293
294
295
296
297
298static void
299mux_set_termios(struct uart_port *port, struct ktermios *termios,
300 struct ktermios *old)
301{
302}
303
304
305
306
307
308
309
310
311static const char *mux_type(struct uart_port *port)
312{
313 return "Mux";
314}
315
316
317
318
319
320
321
322
323static void mux_release_port(struct uart_port *port)
324{
325}
326
327
328
329
330
331
332
333
334
335static int mux_request_port(struct uart_port *port)
336{
337 return 0;
338}
339
340
341
342
343
344
345
346
347
348
349
350
351static void mux_config_port(struct uart_port *port, int type)
352{
353 port->type = PORT_MUX;
354}
355
356
357
358
359
360
361
362
363
364static int mux_verify_port(struct uart_port *port, struct serial_struct *ser)
365{
366 if(port->membase == NULL)
367 return -EINVAL;
368
369 return 0;
370}
371
372
373
374
375
376
377
378static void mux_poll(unsigned long unused)
379{
380 int i;
381
382 for(i = 0; i < port_cnt; ++i) {
383 if(!mux_ports[i].enabled)
384 continue;
385
386 mux_read(&mux_ports[i].port);
387 mux_write(&mux_ports[i].port);
388 }
389
390 mod_timer(&mux_timer, jiffies + MUX_POLL_DELAY);
391}
392
393
394#ifdef CONFIG_SERIAL_MUX_CONSOLE
395static void mux_console_write(struct console *co, const char *s, unsigned count)
396{
397
398 while(UART_GET_FIFO_CNT(&mux_ports[0].port))
399 udelay(1);
400
401 while(count--) {
402 if(*s == '\n') {
403 UART_PUT_CHAR(&mux_ports[0].port, '\r');
404 }
405 UART_PUT_CHAR(&mux_ports[0].port, *s++);
406 }
407
408}
409
410static int mux_console_setup(struct console *co, char *options)
411{
412 return 0;
413}
414
415static struct console mux_console = {
416 .name = "ttyB",
417 .write = mux_console_write,
418 .device = uart_console_device,
419 .setup = mux_console_setup,
420 .flags = CON_ENABLED | CON_PRINTBUFFER,
421 .index = 0,
422 .data = &mux_driver,
423};
424
425#define MUX_CONSOLE &mux_console
426#else
427#define MUX_CONSOLE NULL
428#endif
429
430static struct uart_ops mux_pops = {
431 .tx_empty = mux_tx_empty,
432 .set_mctrl = mux_set_mctrl,
433 .get_mctrl = mux_get_mctrl,
434 .stop_tx = mux_stop_tx,
435 .start_tx = mux_start_tx,
436 .stop_rx = mux_stop_rx,
437 .break_ctl = mux_break_ctl,
438 .startup = mux_startup,
439 .shutdown = mux_shutdown,
440 .set_termios = mux_set_termios,
441 .type = mux_type,
442 .release_port = mux_release_port,
443 .request_port = mux_request_port,
444 .config_port = mux_config_port,
445 .verify_port = mux_verify_port,
446};
447
448
449
450
451
452
453
454
455static int __init mux_probe(struct parisc_device *dev)
456{
457 int i, status;
458
459 int port_count = get_mux_port_count(dev);
460 printk(KERN_INFO "Serial mux driver (%d ports) Revision: 0.6\n", port_count);
461
462 dev_set_drvdata(&dev->dev, (void *)(long)port_count);
463 request_mem_region(dev->hpa.start + MUX_OFFSET,
464 port_count * MUX_LINE_OFFSET, "Mux");
465
466 if(!port_cnt) {
467 mux_driver.cons = MUX_CONSOLE;
468
469 status = uart_register_driver(&mux_driver);
470 if(status) {
471 printk(KERN_ERR "Serial mux: Unable to register driver.\n");
472 return 1;
473 }
474 }
475
476 for(i = 0; i < port_count; ++i, ++port_cnt) {
477 struct uart_port *port = &mux_ports[port_cnt].port;
478 port->iobase = 0;
479 port->mapbase = dev->hpa.start + MUX_OFFSET +
480 (i * MUX_LINE_OFFSET);
481 port->membase = ioremap_nocache(port->mapbase, MUX_LINE_OFFSET);
482 port->iotype = UPIO_MEM;
483 port->type = PORT_MUX;
484 port->irq = 0;
485 port->uartclk = 0;
486 port->fifosize = MUX_FIFO_SIZE;
487 port->ops = &mux_pops;
488 port->flags = UPF_BOOT_AUTOCONF;
489 port->line = port_cnt;
490
491
492
493
494
495
496 port->timeout = HZ / 50;
497 spin_lock_init(&port->lock);
498
499 status = uart_add_one_port(&mux_driver, port);
500 BUG_ON(status);
501 }
502
503 return 0;
504}
505
506static int mux_remove(struct parisc_device *dev)
507{
508 int i, j;
509 int port_count = (long)dev_get_drvdata(&dev->dev);
510
511
512 for(i = 0; i < port_cnt; ++i) {
513 if(mux_ports[i].port.mapbase == dev->hpa.start + MUX_OFFSET)
514 break;
515 }
516 BUG_ON(i + port_count > port_cnt);
517
518
519 for(j = 0; j < port_count; ++j, ++i) {
520 struct uart_port *port = &mux_ports[i].port;
521
522 uart_remove_one_port(&mux_driver, port);
523 if(port->membase)
524 iounmap(port->membase);
525 }
526
527 release_mem_region(dev->hpa.start + MUX_OFFSET, port_count * MUX_LINE_OFFSET);
528 return 0;
529}
530
531
532
533
534
535
536
537
538
539static struct parisc_device_id builtin_mux_tbl[] = {
540 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, 0x15, 0x0000D },
541 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, 0x44, 0x0000D },
542 { 0, }
543};
544
545static struct parisc_device_id mux_tbl[] = {
546 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0000D },
547 { 0, }
548};
549
550MODULE_DEVICE_TABLE(parisc, builtin_mux_tbl);
551MODULE_DEVICE_TABLE(parisc, mux_tbl);
552
553static struct parisc_driver builtin_serial_mux_driver = {
554 .name = "builtin_serial_mux",
555 .id_table = builtin_mux_tbl,
556 .probe = mux_probe,
557 .remove = mux_remove,
558};
559
560static struct parisc_driver serial_mux_driver = {
561 .name = "serial_mux",
562 .id_table = mux_tbl,
563 .probe = mux_probe,
564 .remove = mux_remove,
565};
566
567
568
569
570
571
572static int __init mux_init(void)
573{
574 register_parisc_driver(&builtin_serial_mux_driver);
575 register_parisc_driver(&serial_mux_driver);
576
577 if(port_cnt > 0) {
578
579 init_timer(&mux_timer);
580 mux_timer.function = mux_poll;
581 mod_timer(&mux_timer, jiffies + MUX_POLL_DELAY);
582
583#ifdef CONFIG_SERIAL_MUX_CONSOLE
584 register_console(&mux_console);
585#endif
586 }
587
588 return 0;
589}
590
591
592
593
594
595
596static void __exit mux_exit(void)
597{
598
599 if(port_cnt > 0) {
600 del_timer_sync(&mux_timer);
601#ifdef CONFIG_SERIAL_MUX_CONSOLE
602 unregister_console(&mux_console);
603#endif
604 }
605
606 unregister_parisc_driver(&builtin_serial_mux_driver);
607 unregister_parisc_driver(&serial_mux_driver);
608 uart_unregister_driver(&mux_driver);
609}
610
611module_init(mux_init);
612module_exit(mux_exit);
613
614MODULE_AUTHOR("Ryan Bradetich");
615MODULE_DESCRIPTION("Serial MUX driver");
616MODULE_LICENSE("GPL");
617MODULE_ALIAS_CHARDEV_MAJOR(MUX_MAJOR);
618