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#ifdef 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
177static void mux_enable_ms(struct uart_port *port)
178{
179}
180
181
182
183
184
185
186
187
188static void mux_break_ctl(struct uart_port *port, int break_state)
189{
190}
191
192
193
194
195
196
197
198
199static void mux_write(struct uart_port *port)
200{
201 int count;
202 struct circ_buf *xmit = &port->state->xmit;
203
204 if(port->x_char) {
205 UART_PUT_CHAR(port, port->x_char);
206 port->icount.tx++;
207 port->x_char = 0;
208 return;
209 }
210
211 if(uart_circ_empty(xmit) || uart_tx_stopped(port)) {
212 mux_stop_tx(port);
213 return;
214 }
215
216 count = (port->fifosize) - UART_GET_FIFO_CNT(port);
217 do {
218 UART_PUT_CHAR(port, xmit->buf[xmit->tail]);
219 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
220 port->icount.tx++;
221 if(uart_circ_empty(xmit))
222 break;
223
224 } while(--count > 0);
225
226 while(UART_GET_FIFO_CNT(port))
227 udelay(1);
228
229 if(uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
230 uart_write_wakeup(port);
231
232 if (uart_circ_empty(xmit))
233 mux_stop_tx(port);
234}
235
236
237
238
239
240
241
242
243static void mux_read(struct uart_port *port)
244{
245 struct tty_port *tport = &port->state->port;
246 int data;
247 __u32 start_count = port->icount.rx;
248
249 while(1) {
250 data = __raw_readl(port->membase + IO_DATA_REG_OFFSET);
251
252 if (MUX_STATUS(data))
253 continue;
254
255 if (MUX_EOFIFO(data))
256 break;
257
258 port->icount.rx++;
259
260 if (MUX_BREAK(data)) {
261 port->icount.brk++;
262 if(uart_handle_break(port))
263 continue;
264 }
265
266 if (uart_handle_sysrq_char(port, data & 0xffu))
267 continue;
268
269 tty_insert_flip_char(tport, data & 0xFF, TTY_NORMAL);
270 }
271
272 if (start_count != port->icount.rx)
273 tty_flip_buffer_push(tport);
274}
275
276
277
278
279
280
281
282
283static int mux_startup(struct uart_port *port)
284{
285 mux_ports[port->line].enabled = 1;
286 return 0;
287}
288
289
290
291
292
293
294
295static void mux_shutdown(struct uart_port *port)
296{
297 mux_ports[port->line].enabled = 0;
298}
299
300
301
302
303
304
305
306
307
308static void
309mux_set_termios(struct uart_port *port, struct ktermios *termios,
310 struct ktermios *old)
311{
312}
313
314
315
316
317
318
319
320
321static const char *mux_type(struct uart_port *port)
322{
323 return "Mux";
324}
325
326
327
328
329
330
331
332
333static void mux_release_port(struct uart_port *port)
334{
335}
336
337
338
339
340
341
342
343
344
345static int mux_request_port(struct uart_port *port)
346{
347 return 0;
348}
349
350
351
352
353
354
355
356
357
358
359
360
361static void mux_config_port(struct uart_port *port, int type)
362{
363 port->type = PORT_MUX;
364}
365
366
367
368
369
370
371
372
373
374static int mux_verify_port(struct uart_port *port, struct serial_struct *ser)
375{
376 if(port->membase == NULL)
377 return -EINVAL;
378
379 return 0;
380}
381
382
383
384
385
386
387
388static void mux_poll(unsigned long unused)
389{
390 int i;
391
392 for(i = 0; i < port_cnt; ++i) {
393 if(!mux_ports[i].enabled)
394 continue;
395
396 mux_read(&mux_ports[i].port);
397 mux_write(&mux_ports[i].port);
398 }
399
400 mod_timer(&mux_timer, jiffies + MUX_POLL_DELAY);
401}
402
403
404#ifdef CONFIG_SERIAL_MUX_CONSOLE
405static void mux_console_write(struct console *co, const char *s, unsigned count)
406{
407
408 while(UART_GET_FIFO_CNT(&mux_ports[0].port))
409 udelay(1);
410
411 while(count--) {
412 if(*s == '\n') {
413 UART_PUT_CHAR(&mux_ports[0].port, '\r');
414 }
415 UART_PUT_CHAR(&mux_ports[0].port, *s++);
416 }
417
418}
419
420static int mux_console_setup(struct console *co, char *options)
421{
422 return 0;
423}
424
425struct tty_driver *mux_console_device(struct console *co, int *index)
426{
427 *index = co->index;
428 return mux_driver.tty_driver;
429}
430
431static struct console mux_console = {
432 .name = "ttyB",
433 .write = mux_console_write,
434 .device = mux_console_device,
435 .setup = mux_console_setup,
436 .flags = CON_ENABLED | CON_PRINTBUFFER,
437 .index = 0,
438};
439
440#define MUX_CONSOLE &mux_console
441#else
442#define MUX_CONSOLE NULL
443#endif
444
445static struct uart_ops mux_pops = {
446 .tx_empty = mux_tx_empty,
447 .set_mctrl = mux_set_mctrl,
448 .get_mctrl = mux_get_mctrl,
449 .stop_tx = mux_stop_tx,
450 .start_tx = mux_start_tx,
451 .stop_rx = mux_stop_rx,
452 .enable_ms = mux_enable_ms,
453 .break_ctl = mux_break_ctl,
454 .startup = mux_startup,
455 .shutdown = mux_shutdown,
456 .set_termios = mux_set_termios,
457 .type = mux_type,
458 .release_port = mux_release_port,
459 .request_port = mux_request_port,
460 .config_port = mux_config_port,
461 .verify_port = mux_verify_port,
462};
463
464
465
466
467
468
469
470
471static int __init mux_probe(struct parisc_device *dev)
472{
473 int i, status;
474
475 int port_count = get_mux_port_count(dev);
476 printk(KERN_INFO "Serial mux driver (%d ports) Revision: 0.6\n", port_count);
477
478 dev_set_drvdata(&dev->dev, (void *)(long)port_count);
479 request_mem_region(dev->hpa.start + MUX_OFFSET,
480 port_count * MUX_LINE_OFFSET, "Mux");
481
482 if(!port_cnt) {
483 mux_driver.cons = MUX_CONSOLE;
484
485 status = uart_register_driver(&mux_driver);
486 if(status) {
487 printk(KERN_ERR "Serial mux: Unable to register driver.\n");
488 return 1;
489 }
490 }
491
492 for(i = 0; i < port_count; ++i, ++port_cnt) {
493 struct uart_port *port = &mux_ports[port_cnt].port;
494 port->iobase = 0;
495 port->mapbase = dev->hpa.start + MUX_OFFSET +
496 (i * MUX_LINE_OFFSET);
497 port->membase = ioremap_nocache(port->mapbase, MUX_LINE_OFFSET);
498 port->iotype = UPIO_MEM;
499 port->type = PORT_MUX;
500 port->irq = 0;
501 port->uartclk = 0;
502 port->fifosize = MUX_FIFO_SIZE;
503 port->ops = &mux_pops;
504 port->flags = UPF_BOOT_AUTOCONF;
505 port->line = port_cnt;
506
507
508
509
510
511
512 port->timeout = HZ / 50;
513 spin_lock_init(&port->lock);
514
515 status = uart_add_one_port(&mux_driver, port);
516 BUG_ON(status);
517 }
518
519 return 0;
520}
521
522static int mux_remove(struct parisc_device *dev)
523{
524 int i, j;
525 int port_count = (long)dev_get_drvdata(&dev->dev);
526
527
528 for(i = 0; i < port_cnt; ++i) {
529 if(mux_ports[i].port.mapbase == dev->hpa.start + MUX_OFFSET)
530 break;
531 }
532 BUG_ON(i + port_count > port_cnt);
533
534
535 for(j = 0; j < port_count; ++j, ++i) {
536 struct uart_port *port = &mux_ports[i].port;
537
538 uart_remove_one_port(&mux_driver, port);
539 if(port->membase)
540 iounmap(port->membase);
541 }
542
543 release_mem_region(dev->hpa.start + MUX_OFFSET, port_count * MUX_LINE_OFFSET);
544 return 0;
545}
546
547
548
549
550
551
552
553
554
555static struct parisc_device_id builtin_mux_tbl[] = {
556 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, 0x15, 0x0000D },
557 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, 0x44, 0x0000D },
558 { 0, }
559};
560
561static struct parisc_device_id mux_tbl[] = {
562 { HPHW_A_DIRECT, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0000D },
563 { 0, }
564};
565
566MODULE_DEVICE_TABLE(parisc, builtin_mux_tbl);
567MODULE_DEVICE_TABLE(parisc, mux_tbl);
568
569static struct parisc_driver builtin_serial_mux_driver = {
570 .name = "builtin_serial_mux",
571 .id_table = builtin_mux_tbl,
572 .probe = mux_probe,
573 .remove = mux_remove,
574};
575
576static struct parisc_driver serial_mux_driver = {
577 .name = "serial_mux",
578 .id_table = mux_tbl,
579 .probe = mux_probe,
580 .remove = mux_remove,
581};
582
583
584
585
586
587
588static int __init mux_init(void)
589{
590 register_parisc_driver(&builtin_serial_mux_driver);
591 register_parisc_driver(&serial_mux_driver);
592
593 if(port_cnt > 0) {
594
595 init_timer(&mux_timer);
596 mux_timer.function = mux_poll;
597 mod_timer(&mux_timer, jiffies + MUX_POLL_DELAY);
598
599#ifdef CONFIG_SERIAL_MUX_CONSOLE
600 register_console(&mux_console);
601#endif
602 }
603
604 return 0;
605}
606
607
608
609
610
611
612static void __exit mux_exit(void)
613{
614
615 if(port_cnt > 0) {
616 del_timer(&mux_timer);
617#ifdef CONFIG_SERIAL_MUX_CONSOLE
618 unregister_console(&mux_console);
619#endif
620 }
621
622 unregister_parisc_driver(&builtin_serial_mux_driver);
623 unregister_parisc_driver(&serial_mux_driver);
624 uart_unregister_driver(&mux_driver);
625}
626
627module_init(mux_init);
628module_exit(mux_exit);
629
630MODULE_AUTHOR("Ryan Bradetich");
631MODULE_DESCRIPTION("Serial MUX driver");
632MODULE_LICENSE("GPL");
633MODULE_ALIAS_CHARDEV_MAJOR(MUX_MAJOR);
634