]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/tty/amiserial.c
Merge tag 'for-linus' of git://linux-c6x.org/git/projects/linux-c6x-upstreaming
[mirror_ubuntu-artful-kernel.git] / drivers / tty / amiserial.c
1 /*
2 * Serial driver for the amiga builtin port.
3 *
4 * This code was created by taking serial.c version 4.30 from kernel
5 * release 2.3.22, replacing all hardware related stuff with the
6 * corresponding amiga hardware actions, and removing all irrelevant
7 * code. As a consequence, it uses many of the constants and names
8 * associated with the registers and bits of 16550 compatible UARTS -
9 * but only to keep track of status, etc in the state variables. It
10 * was done this was to make it easier to keep the code in line with
11 * (non hardware specific) changes to serial.c.
12 *
13 * The port is registered with the tty driver as minor device 64, and
14 * therefore other ports should should only use 65 upwards.
15 *
16 * Richard Lucock 28/12/99
17 *
18 * Copyright (C) 1991, 1992 Linus Torvalds
19 * Copyright (C) 1992, 1993, 1994, 1995, 1996, 1997,
20 * 1998, 1999 Theodore Ts'o
21 *
22 */
23
24 /*
25 * Serial driver configuration section. Here are the various options:
26 *
27 * SERIAL_PARANOIA_CHECK
28 * Check the magic number for the async_structure where
29 * ever possible.
30 */
31
32 #include <linux/delay.h>
33
34 #undef SERIAL_PARANOIA_CHECK
35
36 /* Set of debugging defines */
37
38 #undef SERIAL_DEBUG_INTR
39 #undef SERIAL_DEBUG_OPEN
40 #undef SERIAL_DEBUG_FLOW
41 #undef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
42
43 /* Sanity checks */
44
45 #if defined(MODULE) && defined(SERIAL_DEBUG_MCOUNT)
46 #define DBG_CNT(s) printk("(%s): [%x] refc=%d, serc=%d, ttyc=%d -> %s\n", \
47 tty->name, (info->tport.flags), serial_driver->refcount,info->count,tty->count,s)
48 #else
49 #define DBG_CNT(s)
50 #endif
51
52 /*
53 * End of serial driver configuration section.
54 */
55
56 #include <linux/module.h>
57
58 #include <linux/types.h>
59 #include <linux/serial.h>
60 #include <linux/serial_reg.h>
61 static char *serial_version = "4.30";
62
63 #include <linux/errno.h>
64 #include <linux/signal.h>
65 #include <linux/sched.h>
66 #include <linux/kernel.h>
67 #include <linux/timer.h>
68 #include <linux/interrupt.h>
69 #include <linux/tty.h>
70 #include <linux/tty_flip.h>
71 #include <linux/circ_buf.h>
72 #include <linux/console.h>
73 #include <linux/major.h>
74 #include <linux/string.h>
75 #include <linux/fcntl.h>
76 #include <linux/ptrace.h>
77 #include <linux/ioport.h>
78 #include <linux/mm.h>
79 #include <linux/seq_file.h>
80 #include <linux/slab.h>
81 #include <linux/init.h>
82 #include <linux/bitops.h>
83 #include <linux/platform_device.h>
84
85 #include <asm/setup.h>
86
87
88 #include <asm/irq.h>
89
90 #include <asm/amigahw.h>
91 #include <asm/amigaints.h>
92
93 struct serial_state {
94 struct tty_port tport;
95 struct circ_buf xmit;
96 struct async_icount icount;
97
98 unsigned long port;
99 int baud_base;
100 int xmit_fifo_size;
101 int custom_divisor;
102 int read_status_mask;
103 int ignore_status_mask;
104 int timeout;
105 int quot;
106 int IER; /* Interrupt Enable Register */
107 int MCR; /* Modem control register */
108 int x_char; /* xon/xoff character */
109 };
110
111 #define custom amiga_custom
112 static char *serial_name = "Amiga-builtin serial driver";
113
114 static struct tty_driver *serial_driver;
115
116 /* number of characters left in xmit buffer before we ask for more */
117 #define WAKEUP_CHARS 256
118
119 static unsigned char current_ctl_bits;
120
121 static void change_speed(struct tty_struct *tty, struct serial_state *info,
122 struct ktermios *old);
123 static void rs_wait_until_sent(struct tty_struct *tty, int timeout);
124
125
126 static struct serial_state rs_table[1];
127
128 #define NR_PORTS ARRAY_SIZE(rs_table)
129
130 #include <linux/uaccess.h>
131
132 #define serial_isroot() (capable(CAP_SYS_ADMIN))
133
134
135 static inline int serial_paranoia_check(struct serial_state *info,
136 char *name, const char *routine)
137 {
138 #ifdef SERIAL_PARANOIA_CHECK
139 static const char *badmagic =
140 "Warning: bad magic number for serial struct (%s) in %s\n";
141 static const char *badinfo =
142 "Warning: null async_struct for (%s) in %s\n";
143
144 if (!info) {
145 printk(badinfo, name, routine);
146 return 1;
147 }
148 if (info->magic != SERIAL_MAGIC) {
149 printk(badmagic, name, routine);
150 return 1;
151 }
152 #endif
153 return 0;
154 }
155
156 /* some serial hardware definitions */
157 #define SDR_OVRUN (1<<15)
158 #define SDR_RBF (1<<14)
159 #define SDR_TBE (1<<13)
160 #define SDR_TSRE (1<<12)
161
162 #define SERPER_PARENB (1<<15)
163
164 #define AC_SETCLR (1<<15)
165 #define AC_UARTBRK (1<<11)
166
167 #define SER_DTR (1<<7)
168 #define SER_RTS (1<<6)
169 #define SER_DCD (1<<5)
170 #define SER_CTS (1<<4)
171 #define SER_DSR (1<<3)
172
173 static __inline__ void rtsdtr_ctrl(int bits)
174 {
175 ciab.pra = ((bits & (SER_RTS | SER_DTR)) ^ (SER_RTS | SER_DTR)) | (ciab.pra & ~(SER_RTS | SER_DTR));
176 }
177
178 /*
179 * ------------------------------------------------------------
180 * rs_stop() and rs_start()
181 *
182 * This routines are called before setting or resetting tty->stopped.
183 * They enable or disable transmitter interrupts, as necessary.
184 * ------------------------------------------------------------
185 */
186 static void rs_stop(struct tty_struct *tty)
187 {
188 struct serial_state *info = tty->driver_data;
189 unsigned long flags;
190
191 if (serial_paranoia_check(info, tty->name, "rs_stop"))
192 return;
193
194 local_irq_save(flags);
195 if (info->IER & UART_IER_THRI) {
196 info->IER &= ~UART_IER_THRI;
197 /* disable Tx interrupt and remove any pending interrupts */
198 custom.intena = IF_TBE;
199 mb();
200 custom.intreq = IF_TBE;
201 mb();
202 }
203 local_irq_restore(flags);
204 }
205
206 static void rs_start(struct tty_struct *tty)
207 {
208 struct serial_state *info = tty->driver_data;
209 unsigned long flags;
210
211 if (serial_paranoia_check(info, tty->name, "rs_start"))
212 return;
213
214 local_irq_save(flags);
215 if (info->xmit.head != info->xmit.tail
216 && info->xmit.buf
217 && !(info->IER & UART_IER_THRI)) {
218 info->IER |= UART_IER_THRI;
219 custom.intena = IF_SETCLR | IF_TBE;
220 mb();
221 /* set a pending Tx Interrupt, transmitter should restart now */
222 custom.intreq = IF_SETCLR | IF_TBE;
223 mb();
224 }
225 local_irq_restore(flags);
226 }
227
228 /*
229 * ----------------------------------------------------------------------
230 *
231 * Here starts the interrupt handling routines. All of the following
232 * subroutines are declared as inline and are folded into
233 * rs_interrupt(). They were separated out for readability's sake.
234 *
235 * Note: rs_interrupt() is a "fast" interrupt, which means that it
236 * runs with interrupts turned off. People who may want to modify
237 * rs_interrupt() should try to keep the interrupt handler as fast as
238 * possible. After you are done making modifications, it is not a bad
239 * idea to do:
240 *
241 * gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c
242 *
243 * and look at the resulting assemble code in serial.s.
244 *
245 * - Ted Ts'o (tytso@mit.edu), 7-Mar-93
246 * -----------------------------------------------------------------------
247 */
248
249 static void receive_chars(struct serial_state *info)
250 {
251 int status;
252 int serdatr;
253 unsigned char ch, flag;
254 struct async_icount *icount;
255 int oe = 0;
256
257 icount = &info->icount;
258
259 status = UART_LSR_DR; /* We obviously have a character! */
260 serdatr = custom.serdatr;
261 mb();
262 custom.intreq = IF_RBF;
263 mb();
264
265 if((serdatr & 0x1ff) == 0)
266 status |= UART_LSR_BI;
267 if(serdatr & SDR_OVRUN)
268 status |= UART_LSR_OE;
269
270 ch = serdatr & 0xff;
271 icount->rx++;
272
273 #ifdef SERIAL_DEBUG_INTR
274 printk("DR%02x:%02x...", ch, status);
275 #endif
276 flag = TTY_NORMAL;
277
278 /*
279 * We don't handle parity or frame errors - but I have left
280 * the code in, since I'm not sure that the errors can't be
281 * detected.
282 */
283
284 if (status & (UART_LSR_BI | UART_LSR_PE |
285 UART_LSR_FE | UART_LSR_OE)) {
286 /*
287 * For statistics only
288 */
289 if (status & UART_LSR_BI) {
290 status &= ~(UART_LSR_FE | UART_LSR_PE);
291 icount->brk++;
292 } else if (status & UART_LSR_PE)
293 icount->parity++;
294 else if (status & UART_LSR_FE)
295 icount->frame++;
296 if (status & UART_LSR_OE)
297 icount->overrun++;
298
299 /*
300 * Now check to see if character should be
301 * ignored, and mask off conditions which
302 * should be ignored.
303 */
304 if (status & info->ignore_status_mask)
305 goto out;
306
307 status &= info->read_status_mask;
308
309 if (status & (UART_LSR_BI)) {
310 #ifdef SERIAL_DEBUG_INTR
311 printk("handling break....");
312 #endif
313 flag = TTY_BREAK;
314 if (info->tport.flags & ASYNC_SAK)
315 do_SAK(info->tport.tty);
316 } else if (status & UART_LSR_PE)
317 flag = TTY_PARITY;
318 else if (status & UART_LSR_FE)
319 flag = TTY_FRAME;
320 if (status & UART_LSR_OE) {
321 /*
322 * Overrun is special, since it's
323 * reported immediately, and doesn't
324 * affect the current character
325 */
326 oe = 1;
327 }
328 }
329 tty_insert_flip_char(&info->tport, ch, flag);
330 if (oe == 1)
331 tty_insert_flip_char(&info->tport, 0, TTY_OVERRUN);
332 tty_flip_buffer_push(&info->tport);
333 out:
334 return;
335 }
336
337 static void transmit_chars(struct serial_state *info)
338 {
339 custom.intreq = IF_TBE;
340 mb();
341 if (info->x_char) {
342 custom.serdat = info->x_char | 0x100;
343 mb();
344 info->icount.tx++;
345 info->x_char = 0;
346 return;
347 }
348 if (info->xmit.head == info->xmit.tail
349 || info->tport.tty->stopped
350 || info->tport.tty->hw_stopped) {
351 info->IER &= ~UART_IER_THRI;
352 custom.intena = IF_TBE;
353 mb();
354 return;
355 }
356
357 custom.serdat = info->xmit.buf[info->xmit.tail++] | 0x100;
358 mb();
359 info->xmit.tail = info->xmit.tail & (SERIAL_XMIT_SIZE-1);
360 info->icount.tx++;
361
362 if (CIRC_CNT(info->xmit.head,
363 info->xmit.tail,
364 SERIAL_XMIT_SIZE) < WAKEUP_CHARS)
365 tty_wakeup(info->tport.tty);
366
367 #ifdef SERIAL_DEBUG_INTR
368 printk("THRE...");
369 #endif
370 if (info->xmit.head == info->xmit.tail) {
371 custom.intena = IF_TBE;
372 mb();
373 info->IER &= ~UART_IER_THRI;
374 }
375 }
376
377 static void check_modem_status(struct serial_state *info)
378 {
379 struct tty_port *port = &info->tport;
380 unsigned char status = ciab.pra & (SER_DCD | SER_CTS | SER_DSR);
381 unsigned char dstatus;
382 struct async_icount *icount;
383
384 /* Determine bits that have changed */
385 dstatus = status ^ current_ctl_bits;
386 current_ctl_bits = status;
387
388 if (dstatus) {
389 icount = &info->icount;
390 /* update input line counters */
391 if (dstatus & SER_DSR)
392 icount->dsr++;
393 if (dstatus & SER_DCD) {
394 icount->dcd++;
395 }
396 if (dstatus & SER_CTS)
397 icount->cts++;
398 wake_up_interruptible(&port->delta_msr_wait);
399 }
400
401 if (tty_port_check_carrier(port) && (dstatus & SER_DCD)) {
402 #if (defined(SERIAL_DEBUG_OPEN) || defined(SERIAL_DEBUG_INTR))
403 printk("ttyS%d CD now %s...", info->line,
404 (!(status & SER_DCD)) ? "on" : "off");
405 #endif
406 if (!(status & SER_DCD))
407 wake_up_interruptible(&port->open_wait);
408 else {
409 #ifdef SERIAL_DEBUG_OPEN
410 printk("doing serial hangup...");
411 #endif
412 if (port->tty)
413 tty_hangup(port->tty);
414 }
415 }
416 if (tty_port_cts_enabled(port)) {
417 if (port->tty->hw_stopped) {
418 if (!(status & SER_CTS)) {
419 #if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
420 printk("CTS tx start...");
421 #endif
422 port->tty->hw_stopped = 0;
423 info->IER |= UART_IER_THRI;
424 custom.intena = IF_SETCLR | IF_TBE;
425 mb();
426 /* set a pending Tx Interrupt, transmitter should restart now */
427 custom.intreq = IF_SETCLR | IF_TBE;
428 mb();
429 tty_wakeup(port->tty);
430 return;
431 }
432 } else {
433 if ((status & SER_CTS)) {
434 #if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
435 printk("CTS tx stop...");
436 #endif
437 port->tty->hw_stopped = 1;
438 info->IER &= ~UART_IER_THRI;
439 /* disable Tx interrupt and remove any pending interrupts */
440 custom.intena = IF_TBE;
441 mb();
442 custom.intreq = IF_TBE;
443 mb();
444 }
445 }
446 }
447 }
448
449 static irqreturn_t ser_vbl_int( int irq, void *data)
450 {
451 /* vbl is just a periodic interrupt we tie into to update modem status */
452 struct serial_state *info = data;
453 /*
454 * TBD - is it better to unregister from this interrupt or to
455 * ignore it if MSI is clear ?
456 */
457 if(info->IER & UART_IER_MSI)
458 check_modem_status(info);
459 return IRQ_HANDLED;
460 }
461
462 static irqreturn_t ser_rx_int(int irq, void *dev_id)
463 {
464 struct serial_state *info = dev_id;
465
466 #ifdef SERIAL_DEBUG_INTR
467 printk("ser_rx_int...");
468 #endif
469
470 if (!info->tport.tty)
471 return IRQ_NONE;
472
473 receive_chars(info);
474 #ifdef SERIAL_DEBUG_INTR
475 printk("end.\n");
476 #endif
477 return IRQ_HANDLED;
478 }
479
480 static irqreturn_t ser_tx_int(int irq, void *dev_id)
481 {
482 struct serial_state *info = dev_id;
483
484 if (custom.serdatr & SDR_TBE) {
485 #ifdef SERIAL_DEBUG_INTR
486 printk("ser_tx_int...");
487 #endif
488
489 if (!info->tport.tty)
490 return IRQ_NONE;
491
492 transmit_chars(info);
493 #ifdef SERIAL_DEBUG_INTR
494 printk("end.\n");
495 #endif
496 }
497 return IRQ_HANDLED;
498 }
499
500 /*
501 * -------------------------------------------------------------------
502 * Here ends the serial interrupt routines.
503 * -------------------------------------------------------------------
504 */
505
506 /*
507 * ---------------------------------------------------------------
508 * Low level utility subroutines for the serial driver: routines to
509 * figure out the appropriate timeout for an interrupt chain, routines
510 * to initialize and startup a serial port, and routines to shutdown a
511 * serial port. Useful stuff like that.
512 * ---------------------------------------------------------------
513 */
514
515 static int startup(struct tty_struct *tty, struct serial_state *info)
516 {
517 struct tty_port *port = &info->tport;
518 unsigned long flags;
519 int retval=0;
520 unsigned long page;
521
522 page = get_zeroed_page(GFP_KERNEL);
523 if (!page)
524 return -ENOMEM;
525
526 local_irq_save(flags);
527
528 if (tty_port_initialized(port)) {
529 free_page(page);
530 goto errout;
531 }
532
533 if (info->xmit.buf)
534 free_page(page);
535 else
536 info->xmit.buf = (unsigned char *) page;
537
538 #ifdef SERIAL_DEBUG_OPEN
539 printk("starting up ttys%d ...", info->line);
540 #endif
541
542 /* Clear anything in the input buffer */
543
544 custom.intreq = IF_RBF;
545 mb();
546
547 retval = request_irq(IRQ_AMIGA_VERTB, ser_vbl_int, 0, "serial status", info);
548 if (retval) {
549 if (serial_isroot()) {
550 set_bit(TTY_IO_ERROR, &tty->flags);
551 retval = 0;
552 }
553 goto errout;
554 }
555
556 /* enable both Rx and Tx interrupts */
557 custom.intena = IF_SETCLR | IF_RBF | IF_TBE;
558 mb();
559 info->IER = UART_IER_MSI;
560
561 /* remember current state of the DCD and CTS bits */
562 current_ctl_bits = ciab.pra & (SER_DCD | SER_CTS | SER_DSR);
563
564 info->MCR = 0;
565 if (C_BAUD(tty))
566 info->MCR = SER_DTR | SER_RTS;
567 rtsdtr_ctrl(info->MCR);
568
569 clear_bit(TTY_IO_ERROR, &tty->flags);
570 info->xmit.head = info->xmit.tail = 0;
571
572 /*
573 * and set the speed of the serial port
574 */
575 change_speed(tty, info, NULL);
576
577 tty_port_set_initialized(port, 1);
578 local_irq_restore(flags);
579 return 0;
580
581 errout:
582 local_irq_restore(flags);
583 return retval;
584 }
585
586 /*
587 * This routine will shutdown a serial port; interrupts are disabled, and
588 * DTR is dropped if the hangup on close termio flag is on.
589 */
590 static void shutdown(struct tty_struct *tty, struct serial_state *info)
591 {
592 unsigned long flags;
593 struct serial_state *state;
594
595 if (!tty_port_initialized(&info->tport))
596 return;
597
598 state = info;
599
600 #ifdef SERIAL_DEBUG_OPEN
601 printk("Shutting down serial port %d ....\n", info->line);
602 #endif
603
604 local_irq_save(flags); /* Disable interrupts */
605
606 /*
607 * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
608 * here so the queue might never be waken up
609 */
610 wake_up_interruptible(&info->tport.delta_msr_wait);
611
612 /*
613 * Free the IRQ, if necessary
614 */
615 free_irq(IRQ_AMIGA_VERTB, info);
616
617 if (info->xmit.buf) {
618 free_page((unsigned long) info->xmit.buf);
619 info->xmit.buf = NULL;
620 }
621
622 info->IER = 0;
623 custom.intena = IF_RBF | IF_TBE;
624 mb();
625
626 /* disable break condition */
627 custom.adkcon = AC_UARTBRK;
628 mb();
629
630 if (C_HUPCL(tty))
631 info->MCR &= ~(SER_DTR|SER_RTS);
632 rtsdtr_ctrl(info->MCR);
633
634 set_bit(TTY_IO_ERROR, &tty->flags);
635
636 tty_port_set_initialized(&info->tport, 0);
637 local_irq_restore(flags);
638 }
639
640
641 /*
642 * This routine is called to set the UART divisor registers to match
643 * the specified baud rate for a serial port.
644 */
645 static void change_speed(struct tty_struct *tty, struct serial_state *info,
646 struct ktermios *old_termios)
647 {
648 struct tty_port *port = &info->tport;
649 int quot = 0, baud_base, baud;
650 unsigned cflag, cval = 0;
651 int bits;
652 unsigned long flags;
653
654 cflag = tty->termios.c_cflag;
655
656 /* Byte size is always 8 bits plus parity bit if requested */
657
658 cval = 3; bits = 10;
659 if (cflag & CSTOPB) {
660 cval |= 0x04;
661 bits++;
662 }
663 if (cflag & PARENB) {
664 cval |= UART_LCR_PARITY;
665 bits++;
666 }
667 if (!(cflag & PARODD))
668 cval |= UART_LCR_EPAR;
669 #ifdef CMSPAR
670 if (cflag & CMSPAR)
671 cval |= UART_LCR_SPAR;
672 #endif
673
674 /* Determine divisor based on baud rate */
675 baud = tty_get_baud_rate(tty);
676 if (!baud)
677 baud = 9600; /* B0 transition handled in rs_set_termios */
678 baud_base = info->baud_base;
679 if (baud == 38400 && (port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
680 quot = info->custom_divisor;
681 else {
682 if (baud == 134)
683 /* Special case since 134 is really 134.5 */
684 quot = (2*baud_base / 269);
685 else if (baud)
686 quot = baud_base / baud;
687 }
688 /* If the quotient is zero refuse the change */
689 if (!quot && old_termios) {
690 /* FIXME: Will need updating for new tty in the end */
691 tty->termios.c_cflag &= ~CBAUD;
692 tty->termios.c_cflag |= (old_termios->c_cflag & CBAUD);
693 baud = tty_get_baud_rate(tty);
694 if (!baud)
695 baud = 9600;
696 if (baud == 38400 &&
697 (port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
698 quot = info->custom_divisor;
699 else {
700 if (baud == 134)
701 /* Special case since 134 is really 134.5 */
702 quot = (2*baud_base / 269);
703 else if (baud)
704 quot = baud_base / baud;
705 }
706 }
707 /* As a last resort, if the quotient is zero, default to 9600 bps */
708 if (!quot)
709 quot = baud_base / 9600;
710 info->quot = quot;
711 info->timeout = ((info->xmit_fifo_size*HZ*bits*quot) / baud_base);
712 info->timeout += HZ/50; /* Add .02 seconds of slop */
713
714 /* CTS flow control flag and modem status interrupts */
715 info->IER &= ~UART_IER_MSI;
716 if (port->flags & ASYNC_HARDPPS_CD)
717 info->IER |= UART_IER_MSI;
718 tty_port_set_cts_flow(port, cflag & CRTSCTS);
719 if (cflag & CRTSCTS)
720 info->IER |= UART_IER_MSI;
721 tty_port_set_check_carrier(port, ~cflag & CLOCAL);
722 if (~cflag & CLOCAL)
723 info->IER |= UART_IER_MSI;
724 /* TBD:
725 * Does clearing IER_MSI imply that we should disable the VBL interrupt ?
726 */
727
728 /*
729 * Set up parity check flag
730 */
731
732 info->read_status_mask = UART_LSR_OE | UART_LSR_DR;
733 if (I_INPCK(tty))
734 info->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
735 if (I_BRKINT(tty) || I_PARMRK(tty))
736 info->read_status_mask |= UART_LSR_BI;
737
738 /*
739 * Characters to ignore
740 */
741 info->ignore_status_mask = 0;
742 if (I_IGNPAR(tty))
743 info->ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
744 if (I_IGNBRK(tty)) {
745 info->ignore_status_mask |= UART_LSR_BI;
746 /*
747 * If we're ignore parity and break indicators, ignore
748 * overruns too. (For real raw support).
749 */
750 if (I_IGNPAR(tty))
751 info->ignore_status_mask |= UART_LSR_OE;
752 }
753 /*
754 * !!! ignore all characters if CREAD is not set
755 */
756 if ((cflag & CREAD) == 0)
757 info->ignore_status_mask |= UART_LSR_DR;
758 local_irq_save(flags);
759
760 {
761 short serper;
762
763 /* Set up the baud rate */
764 serper = quot - 1;
765
766 /* Enable or disable parity bit */
767
768 if(cval & UART_LCR_PARITY)
769 serper |= (SERPER_PARENB);
770
771 custom.serper = serper;
772 mb();
773 }
774
775 local_irq_restore(flags);
776 }
777
778 static int rs_put_char(struct tty_struct *tty, unsigned char ch)
779 {
780 struct serial_state *info;
781 unsigned long flags;
782
783 info = tty->driver_data;
784
785 if (serial_paranoia_check(info, tty->name, "rs_put_char"))
786 return 0;
787
788 if (!info->xmit.buf)
789 return 0;
790
791 local_irq_save(flags);
792 if (CIRC_SPACE(info->xmit.head,
793 info->xmit.tail,
794 SERIAL_XMIT_SIZE) == 0) {
795 local_irq_restore(flags);
796 return 0;
797 }
798
799 info->xmit.buf[info->xmit.head++] = ch;
800 info->xmit.head &= SERIAL_XMIT_SIZE-1;
801 local_irq_restore(flags);
802 return 1;
803 }
804
805 static void rs_flush_chars(struct tty_struct *tty)
806 {
807 struct serial_state *info = tty->driver_data;
808 unsigned long flags;
809
810 if (serial_paranoia_check(info, tty->name, "rs_flush_chars"))
811 return;
812
813 if (info->xmit.head == info->xmit.tail
814 || tty->stopped
815 || tty->hw_stopped
816 || !info->xmit.buf)
817 return;
818
819 local_irq_save(flags);
820 info->IER |= UART_IER_THRI;
821 custom.intena = IF_SETCLR | IF_TBE;
822 mb();
823 /* set a pending Tx Interrupt, transmitter should restart now */
824 custom.intreq = IF_SETCLR | IF_TBE;
825 mb();
826 local_irq_restore(flags);
827 }
828
829 static int rs_write(struct tty_struct * tty, const unsigned char *buf, int count)
830 {
831 int c, ret = 0;
832 struct serial_state *info = tty->driver_data;
833 unsigned long flags;
834
835 if (serial_paranoia_check(info, tty->name, "rs_write"))
836 return 0;
837
838 if (!info->xmit.buf)
839 return 0;
840
841 local_irq_save(flags);
842 while (1) {
843 c = CIRC_SPACE_TO_END(info->xmit.head,
844 info->xmit.tail,
845 SERIAL_XMIT_SIZE);
846 if (count < c)
847 c = count;
848 if (c <= 0) {
849 break;
850 }
851 memcpy(info->xmit.buf + info->xmit.head, buf, c);
852 info->xmit.head = ((info->xmit.head + c) &
853 (SERIAL_XMIT_SIZE-1));
854 buf += c;
855 count -= c;
856 ret += c;
857 }
858 local_irq_restore(flags);
859
860 if (info->xmit.head != info->xmit.tail
861 && !tty->stopped
862 && !tty->hw_stopped
863 && !(info->IER & UART_IER_THRI)) {
864 info->IER |= UART_IER_THRI;
865 local_irq_disable();
866 custom.intena = IF_SETCLR | IF_TBE;
867 mb();
868 /* set a pending Tx Interrupt, transmitter should restart now */
869 custom.intreq = IF_SETCLR | IF_TBE;
870 mb();
871 local_irq_restore(flags);
872 }
873 return ret;
874 }
875
876 static int rs_write_room(struct tty_struct *tty)
877 {
878 struct serial_state *info = tty->driver_data;
879
880 if (serial_paranoia_check(info, tty->name, "rs_write_room"))
881 return 0;
882 return CIRC_SPACE(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE);
883 }
884
885 static int rs_chars_in_buffer(struct tty_struct *tty)
886 {
887 struct serial_state *info = tty->driver_data;
888
889 if (serial_paranoia_check(info, tty->name, "rs_chars_in_buffer"))
890 return 0;
891 return CIRC_CNT(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE);
892 }
893
894 static void rs_flush_buffer(struct tty_struct *tty)
895 {
896 struct serial_state *info = tty->driver_data;
897 unsigned long flags;
898
899 if (serial_paranoia_check(info, tty->name, "rs_flush_buffer"))
900 return;
901 local_irq_save(flags);
902 info->xmit.head = info->xmit.tail = 0;
903 local_irq_restore(flags);
904 tty_wakeup(tty);
905 }
906
907 /*
908 * This function is used to send a high-priority XON/XOFF character to
909 * the device
910 */
911 static void rs_send_xchar(struct tty_struct *tty, char ch)
912 {
913 struct serial_state *info = tty->driver_data;
914 unsigned long flags;
915
916 if (serial_paranoia_check(info, tty->name, "rs_send_xchar"))
917 return;
918
919 info->x_char = ch;
920 if (ch) {
921 /* Make sure transmit interrupts are on */
922
923 /* Check this ! */
924 local_irq_save(flags);
925 if(!(custom.intenar & IF_TBE)) {
926 custom.intena = IF_SETCLR | IF_TBE;
927 mb();
928 /* set a pending Tx Interrupt, transmitter should restart now */
929 custom.intreq = IF_SETCLR | IF_TBE;
930 mb();
931 }
932 local_irq_restore(flags);
933
934 info->IER |= UART_IER_THRI;
935 }
936 }
937
938 /*
939 * ------------------------------------------------------------
940 * rs_throttle()
941 *
942 * This routine is called by the upper-layer tty layer to signal that
943 * incoming characters should be throttled.
944 * ------------------------------------------------------------
945 */
946 static void rs_throttle(struct tty_struct * tty)
947 {
948 struct serial_state *info = tty->driver_data;
949 unsigned long flags;
950 #ifdef SERIAL_DEBUG_THROTTLE
951 printk("throttle %s ....\n", tty_name(tty));
952 #endif
953
954 if (serial_paranoia_check(info, tty->name, "rs_throttle"))
955 return;
956
957 if (I_IXOFF(tty))
958 rs_send_xchar(tty, STOP_CHAR(tty));
959
960 if (C_CRTSCTS(tty))
961 info->MCR &= ~SER_RTS;
962
963 local_irq_save(flags);
964 rtsdtr_ctrl(info->MCR);
965 local_irq_restore(flags);
966 }
967
968 static void rs_unthrottle(struct tty_struct * tty)
969 {
970 struct serial_state *info = tty->driver_data;
971 unsigned long flags;
972 #ifdef SERIAL_DEBUG_THROTTLE
973 printk("unthrottle %s ....\n", tty_name(tty));
974 #endif
975
976 if (serial_paranoia_check(info, tty->name, "rs_unthrottle"))
977 return;
978
979 if (I_IXOFF(tty)) {
980 if (info->x_char)
981 info->x_char = 0;
982 else
983 rs_send_xchar(tty, START_CHAR(tty));
984 }
985 if (C_CRTSCTS(tty))
986 info->MCR |= SER_RTS;
987 local_irq_save(flags);
988 rtsdtr_ctrl(info->MCR);
989 local_irq_restore(flags);
990 }
991
992 /*
993 * ------------------------------------------------------------
994 * rs_ioctl() and friends
995 * ------------------------------------------------------------
996 */
997
998 static int get_serial_info(struct tty_struct *tty, struct serial_state *state,
999 struct serial_struct __user * retinfo)
1000 {
1001 struct serial_struct tmp;
1002
1003 memset(&tmp, 0, sizeof(tmp));
1004 tty_lock(tty);
1005 tmp.line = tty->index;
1006 tmp.port = state->port;
1007 tmp.flags = state->tport.flags;
1008 tmp.xmit_fifo_size = state->xmit_fifo_size;
1009 tmp.baud_base = state->baud_base;
1010 tmp.close_delay = state->tport.close_delay;
1011 tmp.closing_wait = state->tport.closing_wait;
1012 tmp.custom_divisor = state->custom_divisor;
1013 tty_unlock(tty);
1014 if (copy_to_user(retinfo,&tmp,sizeof(*retinfo)))
1015 return -EFAULT;
1016 return 0;
1017 }
1018
1019 static int set_serial_info(struct tty_struct *tty, struct serial_state *state,
1020 struct serial_struct __user * new_info)
1021 {
1022 struct tty_port *port = &state->tport;
1023 struct serial_struct new_serial;
1024 bool change_spd;
1025 int retval = 0;
1026
1027 if (copy_from_user(&new_serial,new_info,sizeof(new_serial)))
1028 return -EFAULT;
1029
1030 tty_lock(tty);
1031 change_spd = ((new_serial.flags ^ port->flags) & ASYNC_SPD_MASK) ||
1032 new_serial.custom_divisor != state->custom_divisor;
1033 if (new_serial.irq || new_serial.port != state->port ||
1034 new_serial.xmit_fifo_size != state->xmit_fifo_size) {
1035 tty_unlock(tty);
1036 return -EINVAL;
1037 }
1038
1039 if (!serial_isroot()) {
1040 if ((new_serial.baud_base != state->baud_base) ||
1041 (new_serial.close_delay != port->close_delay) ||
1042 (new_serial.xmit_fifo_size != state->xmit_fifo_size) ||
1043 ((new_serial.flags & ~ASYNC_USR_MASK) !=
1044 (port->flags & ~ASYNC_USR_MASK))) {
1045 tty_unlock(tty);
1046 return -EPERM;
1047 }
1048 port->flags = ((port->flags & ~ASYNC_USR_MASK) |
1049 (new_serial.flags & ASYNC_USR_MASK));
1050 state->custom_divisor = new_serial.custom_divisor;
1051 goto check_and_exit;
1052 }
1053
1054 if (new_serial.baud_base < 9600) {
1055 tty_unlock(tty);
1056 return -EINVAL;
1057 }
1058
1059 /*
1060 * OK, past this point, all the error checking has been done.
1061 * At this point, we start making changes.....
1062 */
1063
1064 state->baud_base = new_serial.baud_base;
1065 port->flags = ((port->flags & ~ASYNC_FLAGS) |
1066 (new_serial.flags & ASYNC_FLAGS));
1067 state->custom_divisor = new_serial.custom_divisor;
1068 port->close_delay = new_serial.close_delay * HZ/100;
1069 port->closing_wait = new_serial.closing_wait * HZ/100;
1070 port->low_latency = (port->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1071
1072 check_and_exit:
1073 if (tty_port_initialized(port)) {
1074 if (change_spd) {
1075 /* warn about deprecation unless clearing */
1076 if (new_serial.flags & ASYNC_SPD_MASK)
1077 dev_warn_ratelimited(tty->dev, "use of SPD flags is deprecated\n");
1078 change_speed(tty, state, NULL);
1079 }
1080 } else
1081 retval = startup(tty, state);
1082 tty_unlock(tty);
1083 return retval;
1084 }
1085
1086
1087 /*
1088 * get_lsr_info - get line status register info
1089 *
1090 * Purpose: Let user call ioctl() to get info when the UART physically
1091 * is emptied. On bus types like RS485, the transmitter must
1092 * release the bus after transmitting. This must be done when
1093 * the transmit shift register is empty, not be done when the
1094 * transmit holding register is empty. This functionality
1095 * allows an RS485 driver to be written in user space.
1096 */
1097 static int get_lsr_info(struct serial_state *info, unsigned int __user *value)
1098 {
1099 unsigned char status;
1100 unsigned int result;
1101 unsigned long flags;
1102
1103 local_irq_save(flags);
1104 status = custom.serdatr;
1105 mb();
1106 local_irq_restore(flags);
1107 result = ((status & SDR_TSRE) ? TIOCSER_TEMT : 0);
1108 if (copy_to_user(value, &result, sizeof(int)))
1109 return -EFAULT;
1110 return 0;
1111 }
1112
1113
1114 static int rs_tiocmget(struct tty_struct *tty)
1115 {
1116 struct serial_state *info = tty->driver_data;
1117 unsigned char control, status;
1118 unsigned long flags;
1119
1120 if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1121 return -ENODEV;
1122 if (tty_io_error(tty))
1123 return -EIO;
1124
1125 control = info->MCR;
1126 local_irq_save(flags);
1127 status = ciab.pra;
1128 local_irq_restore(flags);
1129 return ((control & SER_RTS) ? TIOCM_RTS : 0)
1130 | ((control & SER_DTR) ? TIOCM_DTR : 0)
1131 | (!(status & SER_DCD) ? TIOCM_CAR : 0)
1132 | (!(status & SER_DSR) ? TIOCM_DSR : 0)
1133 | (!(status & SER_CTS) ? TIOCM_CTS : 0);
1134 }
1135
1136 static int rs_tiocmset(struct tty_struct *tty, unsigned int set,
1137 unsigned int clear)
1138 {
1139 struct serial_state *info = tty->driver_data;
1140 unsigned long flags;
1141
1142 if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1143 return -ENODEV;
1144 if (tty_io_error(tty))
1145 return -EIO;
1146
1147 local_irq_save(flags);
1148 if (set & TIOCM_RTS)
1149 info->MCR |= SER_RTS;
1150 if (set & TIOCM_DTR)
1151 info->MCR |= SER_DTR;
1152 if (clear & TIOCM_RTS)
1153 info->MCR &= ~SER_RTS;
1154 if (clear & TIOCM_DTR)
1155 info->MCR &= ~SER_DTR;
1156 rtsdtr_ctrl(info->MCR);
1157 local_irq_restore(flags);
1158 return 0;
1159 }
1160
1161 /*
1162 * rs_break() --- routine which turns the break handling on or off
1163 */
1164 static int rs_break(struct tty_struct *tty, int break_state)
1165 {
1166 struct serial_state *info = tty->driver_data;
1167 unsigned long flags;
1168
1169 if (serial_paranoia_check(info, tty->name, "rs_break"))
1170 return -EINVAL;
1171
1172 local_irq_save(flags);
1173 if (break_state == -1)
1174 custom.adkcon = AC_SETCLR | AC_UARTBRK;
1175 else
1176 custom.adkcon = AC_UARTBRK;
1177 mb();
1178 local_irq_restore(flags);
1179 return 0;
1180 }
1181
1182 /*
1183 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
1184 * Return: write counters to the user passed counter struct
1185 * NB: both 1->0 and 0->1 transitions are counted except for
1186 * RI where only 0->1 is counted.
1187 */
1188 static int rs_get_icount(struct tty_struct *tty,
1189 struct serial_icounter_struct *icount)
1190 {
1191 struct serial_state *info = tty->driver_data;
1192 struct async_icount cnow;
1193 unsigned long flags;
1194
1195 local_irq_save(flags);
1196 cnow = info->icount;
1197 local_irq_restore(flags);
1198 icount->cts = cnow.cts;
1199 icount->dsr = cnow.dsr;
1200 icount->rng = cnow.rng;
1201 icount->dcd = cnow.dcd;
1202 icount->rx = cnow.rx;
1203 icount->tx = cnow.tx;
1204 icount->frame = cnow.frame;
1205 icount->overrun = cnow.overrun;
1206 icount->parity = cnow.parity;
1207 icount->brk = cnow.brk;
1208 icount->buf_overrun = cnow.buf_overrun;
1209
1210 return 0;
1211 }
1212
1213 static int rs_ioctl(struct tty_struct *tty,
1214 unsigned int cmd, unsigned long arg)
1215 {
1216 struct serial_state *info = tty->driver_data;
1217 struct async_icount cprev, cnow; /* kernel counter temps */
1218 void __user *argp = (void __user *)arg;
1219 unsigned long flags;
1220 DEFINE_WAIT(wait);
1221 int ret;
1222
1223 if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1224 return -ENODEV;
1225
1226 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1227 (cmd != TIOCSERCONFIG) && (cmd != TIOCSERGSTRUCT) &&
1228 (cmd != TIOCMIWAIT) && (cmd != TIOCGICOUNT)) {
1229 if (tty_io_error(tty))
1230 return -EIO;
1231 }
1232
1233 switch (cmd) {
1234 case TIOCGSERIAL:
1235 return get_serial_info(tty, info, argp);
1236 case TIOCSSERIAL:
1237 return set_serial_info(tty, info, argp);
1238 case TIOCSERCONFIG:
1239 return 0;
1240
1241 case TIOCSERGETLSR: /* Get line status register */
1242 return get_lsr_info(info, argp);
1243
1244 case TIOCSERGSTRUCT:
1245 if (copy_to_user(argp,
1246 info, sizeof(struct serial_state)))
1247 return -EFAULT;
1248 return 0;
1249
1250 /*
1251 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
1252 * - mask passed in arg for lines of interest
1253 * (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
1254 * Caller should use TIOCGICOUNT to see which one it was
1255 */
1256 case TIOCMIWAIT:
1257 local_irq_save(flags);
1258 /* note the counters on entry */
1259 cprev = info->icount;
1260 local_irq_restore(flags);
1261 while (1) {
1262 prepare_to_wait(&info->tport.delta_msr_wait,
1263 &wait, TASK_INTERRUPTIBLE);
1264 local_irq_save(flags);
1265 cnow = info->icount; /* atomic copy */
1266 local_irq_restore(flags);
1267 if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
1268 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) {
1269 ret = -EIO; /* no change => error */
1270 break;
1271 }
1272 if ( ((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
1273 ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
1274 ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
1275 ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
1276 ret = 0;
1277 break;
1278 }
1279 schedule();
1280 /* see if a signal did it */
1281 if (signal_pending(current)) {
1282 ret = -ERESTARTSYS;
1283 break;
1284 }
1285 cprev = cnow;
1286 }
1287 finish_wait(&info->tport.delta_msr_wait, &wait);
1288 return ret;
1289
1290 case TIOCSERGWILD:
1291 case TIOCSERSWILD:
1292 /* "setserial -W" is called in Debian boot */
1293 printk ("TIOCSER?WILD ioctl obsolete, ignored.\n");
1294 return 0;
1295
1296 default:
1297 return -ENOIOCTLCMD;
1298 }
1299 return 0;
1300 }
1301
1302 static void rs_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
1303 {
1304 struct serial_state *info = tty->driver_data;
1305 unsigned long flags;
1306 unsigned int cflag = tty->termios.c_cflag;
1307
1308 change_speed(tty, info, old_termios);
1309
1310 /* Handle transition to B0 status */
1311 if ((old_termios->c_cflag & CBAUD) && !(cflag & CBAUD)) {
1312 info->MCR &= ~(SER_DTR|SER_RTS);
1313 local_irq_save(flags);
1314 rtsdtr_ctrl(info->MCR);
1315 local_irq_restore(flags);
1316 }
1317
1318 /* Handle transition away from B0 status */
1319 if (!(old_termios->c_cflag & CBAUD) && (cflag & CBAUD)) {
1320 info->MCR |= SER_DTR;
1321 if (!C_CRTSCTS(tty) || !tty_throttled(tty))
1322 info->MCR |= SER_RTS;
1323 local_irq_save(flags);
1324 rtsdtr_ctrl(info->MCR);
1325 local_irq_restore(flags);
1326 }
1327
1328 /* Handle turning off CRTSCTS */
1329 if ((old_termios->c_cflag & CRTSCTS) && !C_CRTSCTS(tty)) {
1330 tty->hw_stopped = 0;
1331 rs_start(tty);
1332 }
1333
1334 #if 0
1335 /*
1336 * No need to wake up processes in open wait, since they
1337 * sample the CLOCAL flag once, and don't recheck it.
1338 * XXX It's not clear whether the current behavior is correct
1339 * or not. Hence, this may change.....
1340 */
1341 if (!(old_termios->c_cflag & CLOCAL) && C_CLOCAL(tty))
1342 wake_up_interruptible(&info->open_wait);
1343 #endif
1344 }
1345
1346 /*
1347 * ------------------------------------------------------------
1348 * rs_close()
1349 *
1350 * This routine is called when the serial port gets closed. First, we
1351 * wait for the last remaining data to be sent. Then, we unlink its
1352 * async structure from the interrupt chain if necessary, and we free
1353 * that IRQ if nothing is left in the chain.
1354 * ------------------------------------------------------------
1355 */
1356 static void rs_close(struct tty_struct *tty, struct file * filp)
1357 {
1358 struct serial_state *state = tty->driver_data;
1359 struct tty_port *port = &state->tport;
1360
1361 if (serial_paranoia_check(state, tty->name, "rs_close"))
1362 return;
1363
1364 if (tty_port_close_start(port, tty, filp) == 0)
1365 return;
1366
1367 /*
1368 * At this point we stop accepting input. To do this, we
1369 * disable the receive line status interrupts, and tell the
1370 * interrupt driver to stop checking the data ready bit in the
1371 * line status register.
1372 */
1373 state->read_status_mask &= ~UART_LSR_DR;
1374 if (tty_port_initialized(port)) {
1375 /* disable receive interrupts */
1376 custom.intena = IF_RBF;
1377 mb();
1378 /* clear any pending receive interrupt */
1379 custom.intreq = IF_RBF;
1380 mb();
1381
1382 /*
1383 * Before we drop DTR, make sure the UART transmitter
1384 * has completely drained; this is especially
1385 * important if there is a transmit FIFO!
1386 */
1387 rs_wait_until_sent(tty, state->timeout);
1388 }
1389 shutdown(tty, state);
1390 rs_flush_buffer(tty);
1391
1392 tty_ldisc_flush(tty);
1393 port->tty = NULL;
1394
1395 tty_port_close_end(port, tty);
1396 }
1397
1398 /*
1399 * rs_wait_until_sent() --- wait until the transmitter is empty
1400 */
1401 static void rs_wait_until_sent(struct tty_struct *tty, int timeout)
1402 {
1403 struct serial_state *info = tty->driver_data;
1404 unsigned long orig_jiffies, char_time;
1405 int lsr;
1406
1407 if (serial_paranoia_check(info, tty->name, "rs_wait_until_sent"))
1408 return;
1409
1410 if (info->xmit_fifo_size == 0)
1411 return; /* Just in case.... */
1412
1413 orig_jiffies = jiffies;
1414
1415 /*
1416 * Set the check interval to be 1/5 of the estimated time to
1417 * send a single character, and make it at least 1. The check
1418 * interval should also be less than the timeout.
1419 *
1420 * Note: we have to use pretty tight timings here to satisfy
1421 * the NIST-PCTS.
1422 */
1423 char_time = (info->timeout - HZ/50) / info->xmit_fifo_size;
1424 char_time = char_time / 5;
1425 if (char_time == 0)
1426 char_time = 1;
1427 if (timeout)
1428 char_time = min_t(unsigned long, char_time, timeout);
1429 /*
1430 * If the transmitter hasn't cleared in twice the approximate
1431 * amount of time to send the entire FIFO, it probably won't
1432 * ever clear. This assumes the UART isn't doing flow
1433 * control, which is currently the case. Hence, if it ever
1434 * takes longer than info->timeout, this is probably due to a
1435 * UART bug of some kind. So, we clamp the timeout parameter at
1436 * 2*info->timeout.
1437 */
1438 if (!timeout || timeout > 2*info->timeout)
1439 timeout = 2*info->timeout;
1440 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1441 printk("In rs_wait_until_sent(%d) check=%lu...", timeout, char_time);
1442 printk("jiff=%lu...", jiffies);
1443 #endif
1444 while(!((lsr = custom.serdatr) & SDR_TSRE)) {
1445 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1446 printk("serdatr = %d (jiff=%lu)...", lsr, jiffies);
1447 #endif
1448 msleep_interruptible(jiffies_to_msecs(char_time));
1449 if (signal_pending(current))
1450 break;
1451 if (timeout && time_after(jiffies, orig_jiffies + timeout))
1452 break;
1453 }
1454 __set_current_state(TASK_RUNNING);
1455
1456 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1457 printk("lsr = %d (jiff=%lu)...done\n", lsr, jiffies);
1458 #endif
1459 }
1460
1461 /*
1462 * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1463 */
1464 static void rs_hangup(struct tty_struct *tty)
1465 {
1466 struct serial_state *info = tty->driver_data;
1467
1468 if (serial_paranoia_check(info, tty->name, "rs_hangup"))
1469 return;
1470
1471 rs_flush_buffer(tty);
1472 shutdown(tty, info);
1473 info->tport.count = 0;
1474 tty_port_set_active(&info->tport, 0);
1475 info->tport.tty = NULL;
1476 wake_up_interruptible(&info->tport.open_wait);
1477 }
1478
1479 /*
1480 * This routine is called whenever a serial port is opened. It
1481 * enables interrupts for a serial port, linking in its async structure into
1482 * the IRQ chain. It also performs the serial-specific
1483 * initialization for the tty structure.
1484 */
1485 static int rs_open(struct tty_struct *tty, struct file * filp)
1486 {
1487 struct serial_state *info = rs_table + tty->index;
1488 struct tty_port *port = &info->tport;
1489 int retval;
1490
1491 port->count++;
1492 port->tty = tty;
1493 tty->driver_data = info;
1494 tty->port = port;
1495 if (serial_paranoia_check(info, tty->name, "rs_open"))
1496 return -ENODEV;
1497
1498 port->low_latency = (port->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1499
1500 retval = startup(tty, info);
1501 if (retval) {
1502 return retval;
1503 }
1504
1505 return tty_port_block_til_ready(port, tty, filp);
1506 }
1507
1508 /*
1509 * /proc fs routines....
1510 */
1511
1512 static inline void line_info(struct seq_file *m, int line,
1513 struct serial_state *state)
1514 {
1515 char stat_buf[30], control, status;
1516 unsigned long flags;
1517
1518 seq_printf(m, "%d: uart:amiga_builtin", line);
1519
1520 local_irq_save(flags);
1521 status = ciab.pra;
1522 control = tty_port_initialized(&state->tport) ? state->MCR : status;
1523 local_irq_restore(flags);
1524
1525 stat_buf[0] = 0;
1526 stat_buf[1] = 0;
1527 if(!(control & SER_RTS))
1528 strcat(stat_buf, "|RTS");
1529 if(!(status & SER_CTS))
1530 strcat(stat_buf, "|CTS");
1531 if(!(control & SER_DTR))
1532 strcat(stat_buf, "|DTR");
1533 if(!(status & SER_DSR))
1534 strcat(stat_buf, "|DSR");
1535 if(!(status & SER_DCD))
1536 strcat(stat_buf, "|CD");
1537
1538 if (state->quot)
1539 seq_printf(m, " baud:%d", state->baud_base / state->quot);
1540
1541 seq_printf(m, " tx:%d rx:%d", state->icount.tx, state->icount.rx);
1542
1543 if (state->icount.frame)
1544 seq_printf(m, " fe:%d", state->icount.frame);
1545
1546 if (state->icount.parity)
1547 seq_printf(m, " pe:%d", state->icount.parity);
1548
1549 if (state->icount.brk)
1550 seq_printf(m, " brk:%d", state->icount.brk);
1551
1552 if (state->icount.overrun)
1553 seq_printf(m, " oe:%d", state->icount.overrun);
1554
1555 /*
1556 * Last thing is the RS-232 status lines
1557 */
1558 seq_printf(m, " %s\n", stat_buf+1);
1559 }
1560
1561 static int rs_proc_show(struct seq_file *m, void *v)
1562 {
1563 seq_printf(m, "serinfo:1.0 driver:%s\n", serial_version);
1564 line_info(m, 0, &rs_table[0]);
1565 return 0;
1566 }
1567
1568 static int rs_proc_open(struct inode *inode, struct file *file)
1569 {
1570 return single_open(file, rs_proc_show, NULL);
1571 }
1572
1573 static const struct file_operations rs_proc_fops = {
1574 .owner = THIS_MODULE,
1575 .open = rs_proc_open,
1576 .read = seq_read,
1577 .llseek = seq_lseek,
1578 .release = single_release,
1579 };
1580
1581 /*
1582 * ---------------------------------------------------------------------
1583 * rs_init() and friends
1584 *
1585 * rs_init() is called at boot-time to initialize the serial driver.
1586 * ---------------------------------------------------------------------
1587 */
1588
1589 /*
1590 * This routine prints out the appropriate serial driver version
1591 * number, and identifies which options were configured into this
1592 * driver.
1593 */
1594 static void show_serial_version(void)
1595 {
1596 printk(KERN_INFO "%s version %s\n", serial_name, serial_version);
1597 }
1598
1599
1600 static const struct tty_operations serial_ops = {
1601 .open = rs_open,
1602 .close = rs_close,
1603 .write = rs_write,
1604 .put_char = rs_put_char,
1605 .flush_chars = rs_flush_chars,
1606 .write_room = rs_write_room,
1607 .chars_in_buffer = rs_chars_in_buffer,
1608 .flush_buffer = rs_flush_buffer,
1609 .ioctl = rs_ioctl,
1610 .throttle = rs_throttle,
1611 .unthrottle = rs_unthrottle,
1612 .set_termios = rs_set_termios,
1613 .stop = rs_stop,
1614 .start = rs_start,
1615 .hangup = rs_hangup,
1616 .break_ctl = rs_break,
1617 .send_xchar = rs_send_xchar,
1618 .wait_until_sent = rs_wait_until_sent,
1619 .tiocmget = rs_tiocmget,
1620 .tiocmset = rs_tiocmset,
1621 .get_icount = rs_get_icount,
1622 .proc_fops = &rs_proc_fops,
1623 };
1624
1625 static int amiga_carrier_raised(struct tty_port *port)
1626 {
1627 return !(ciab.pra & SER_DCD);
1628 }
1629
1630 static void amiga_dtr_rts(struct tty_port *port, int raise)
1631 {
1632 struct serial_state *info = container_of(port, struct serial_state,
1633 tport);
1634 unsigned long flags;
1635
1636 if (raise)
1637 info->MCR |= SER_DTR|SER_RTS;
1638 else
1639 info->MCR &= ~(SER_DTR|SER_RTS);
1640
1641 local_irq_save(flags);
1642 rtsdtr_ctrl(info->MCR);
1643 local_irq_restore(flags);
1644 }
1645
1646 static const struct tty_port_operations amiga_port_ops = {
1647 .carrier_raised = amiga_carrier_raised,
1648 .dtr_rts = amiga_dtr_rts,
1649 };
1650
1651 /*
1652 * The serial driver boot-time initialization code!
1653 */
1654 static int __init amiga_serial_probe(struct platform_device *pdev)
1655 {
1656 unsigned long flags;
1657 struct serial_state * state;
1658 int error;
1659
1660 serial_driver = alloc_tty_driver(NR_PORTS);
1661 if (!serial_driver)
1662 return -ENOMEM;
1663
1664 show_serial_version();
1665
1666 /* Initialize the tty_driver structure */
1667
1668 serial_driver->driver_name = "amiserial";
1669 serial_driver->name = "ttyS";
1670 serial_driver->major = TTY_MAJOR;
1671 serial_driver->minor_start = 64;
1672 serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
1673 serial_driver->subtype = SERIAL_TYPE_NORMAL;
1674 serial_driver->init_termios = tty_std_termios;
1675 serial_driver->init_termios.c_cflag =
1676 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
1677 serial_driver->flags = TTY_DRIVER_REAL_RAW;
1678 tty_set_operations(serial_driver, &serial_ops);
1679
1680 state = rs_table;
1681 state->port = (int)&custom.serdatr; /* Just to give it a value */
1682 state->custom_divisor = 0;
1683 state->icount.cts = state->icount.dsr =
1684 state->icount.rng = state->icount.dcd = 0;
1685 state->icount.rx = state->icount.tx = 0;
1686 state->icount.frame = state->icount.parity = 0;
1687 state->icount.overrun = state->icount.brk = 0;
1688 tty_port_init(&state->tport);
1689 state->tport.ops = &amiga_port_ops;
1690 tty_port_link_device(&state->tport, serial_driver, 0);
1691
1692 error = tty_register_driver(serial_driver);
1693 if (error)
1694 goto fail_put_tty_driver;
1695
1696 printk(KERN_INFO "ttyS0 is the amiga builtin serial port\n");
1697
1698 /* Hardware set up */
1699
1700 state->baud_base = amiga_colorclock;
1701 state->xmit_fifo_size = 1;
1702
1703 /* set ISRs, and then disable the rx interrupts */
1704 error = request_irq(IRQ_AMIGA_TBE, ser_tx_int, 0, "serial TX", state);
1705 if (error)
1706 goto fail_unregister;
1707
1708 error = request_irq(IRQ_AMIGA_RBF, ser_rx_int, 0,
1709 "serial RX", state);
1710 if (error)
1711 goto fail_free_irq;
1712
1713 local_irq_save(flags);
1714
1715 /* turn off Rx and Tx interrupts */
1716 custom.intena = IF_RBF | IF_TBE;
1717 mb();
1718
1719 /* clear any pending interrupt */
1720 custom.intreq = IF_RBF | IF_TBE;
1721 mb();
1722
1723 local_irq_restore(flags);
1724
1725 /*
1726 * set the appropriate directions for the modem control flags,
1727 * and clear RTS and DTR
1728 */
1729 ciab.ddra |= (SER_DTR | SER_RTS); /* outputs */
1730 ciab.ddra &= ~(SER_DCD | SER_CTS | SER_DSR); /* inputs */
1731
1732 platform_set_drvdata(pdev, state);
1733
1734 return 0;
1735
1736 fail_free_irq:
1737 free_irq(IRQ_AMIGA_TBE, state);
1738 fail_unregister:
1739 tty_unregister_driver(serial_driver);
1740 fail_put_tty_driver:
1741 tty_port_destroy(&state->tport);
1742 put_tty_driver(serial_driver);
1743 return error;
1744 }
1745
1746 static int __exit amiga_serial_remove(struct platform_device *pdev)
1747 {
1748 int error;
1749 struct serial_state *state = platform_get_drvdata(pdev);
1750
1751 /* printk("Unloading %s: version %s\n", serial_name, serial_version); */
1752 error = tty_unregister_driver(serial_driver);
1753 if (error)
1754 printk("SERIAL: failed to unregister serial driver (%d)\n",
1755 error);
1756 put_tty_driver(serial_driver);
1757 tty_port_destroy(&state->tport);
1758
1759 free_irq(IRQ_AMIGA_TBE, state);
1760 free_irq(IRQ_AMIGA_RBF, state);
1761
1762 return error;
1763 }
1764
1765 static struct platform_driver amiga_serial_driver = {
1766 .remove = __exit_p(amiga_serial_remove),
1767 .driver = {
1768 .name = "amiga-serial",
1769 },
1770 };
1771
1772 module_platform_driver_probe(amiga_serial_driver, amiga_serial_probe);
1773
1774
1775 #if defined(CONFIG_SERIAL_CONSOLE) && !defined(MODULE)
1776
1777 /*
1778 * ------------------------------------------------------------
1779 * Serial console driver
1780 * ------------------------------------------------------------
1781 */
1782
1783 static void amiga_serial_putc(char c)
1784 {
1785 custom.serdat = (unsigned char)c | 0x100;
1786 while (!(custom.serdatr & 0x2000))
1787 barrier();
1788 }
1789
1790 /*
1791 * Print a string to the serial port trying not to disturb
1792 * any possible real use of the port...
1793 *
1794 * The console must be locked when we get here.
1795 */
1796 static void serial_console_write(struct console *co, const char *s,
1797 unsigned count)
1798 {
1799 unsigned short intena = custom.intenar;
1800
1801 custom.intena = IF_TBE;
1802
1803 while (count--) {
1804 if (*s == '\n')
1805 amiga_serial_putc('\r');
1806 amiga_serial_putc(*s++);
1807 }
1808
1809 custom.intena = IF_SETCLR | (intena & IF_TBE);
1810 }
1811
1812 static struct tty_driver *serial_console_device(struct console *c, int *index)
1813 {
1814 *index = 0;
1815 return serial_driver;
1816 }
1817
1818 static struct console sercons = {
1819 .name = "ttyS",
1820 .write = serial_console_write,
1821 .device = serial_console_device,
1822 .flags = CON_PRINTBUFFER,
1823 .index = -1,
1824 };
1825
1826 /*
1827 * Register console.
1828 */
1829 static int __init amiserial_console_init(void)
1830 {
1831 if (!MACH_IS_AMIGA)
1832 return -ENODEV;
1833
1834 register_console(&sercons);
1835 return 0;
1836 }
1837 console_initcall(amiserial_console_init);
1838
1839 #endif /* CONFIG_SERIAL_CONSOLE && !MODULE */
1840
1841 MODULE_LICENSE("GPL");
1842 MODULE_ALIAS("platform:amiga-serial");