xref: /openbmc/linux/drivers/tty/amiserial.c (revision 781095f903f398148cd0b646d3984234a715f29e)
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 <asm/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 ((port->flags & ASYNC_CHECK_CD) && (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 (port->flags & ASYNC_INITIALIZED) {
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 	 * Set up the tty->alt_speed kludge
574 	 */
575 	if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
576 		tty->alt_speed = 57600;
577 	if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
578 		tty->alt_speed = 115200;
579 	if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
580 		tty->alt_speed = 230400;
581 	if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
582 		tty->alt_speed = 460800;
583 
584 	/*
585 	 * and set the speed of the serial port
586 	 */
587 	change_speed(tty, info, NULL);
588 
589 	port->flags |= ASYNC_INITIALIZED;
590 	local_irq_restore(flags);
591 	return 0;
592 
593 errout:
594 	local_irq_restore(flags);
595 	return retval;
596 }
597 
598 /*
599  * This routine will shutdown a serial port; interrupts are disabled, and
600  * DTR is dropped if the hangup on close termio flag is on.
601  */
602 static void shutdown(struct tty_struct *tty, struct serial_state *info)
603 {
604 	unsigned long	flags;
605 	struct serial_state *state;
606 
607 	if (!(info->tport.flags & ASYNC_INITIALIZED))
608 		return;
609 
610 	state = info;
611 
612 #ifdef SERIAL_DEBUG_OPEN
613 	printk("Shutting down serial port %d ....\n", info->line);
614 #endif
615 
616 	local_irq_save(flags); /* Disable interrupts */
617 
618 	/*
619 	 * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
620 	 * here so the queue might never be waken up
621 	 */
622 	wake_up_interruptible(&info->tport.delta_msr_wait);
623 
624 	/*
625 	 * Free the IRQ, if necessary
626 	 */
627 	free_irq(IRQ_AMIGA_VERTB, info);
628 
629 	if (info->xmit.buf) {
630 		free_page((unsigned long) info->xmit.buf);
631 		info->xmit.buf = NULL;
632 	}
633 
634 	info->IER = 0;
635 	custom.intena = IF_RBF | IF_TBE;
636 	mb();
637 
638 	/* disable break condition */
639 	custom.adkcon = AC_UARTBRK;
640 	mb();
641 
642 	if (tty->termios.c_cflag & HUPCL)
643 		info->MCR &= ~(SER_DTR|SER_RTS);
644 	rtsdtr_ctrl(info->MCR);
645 
646 	set_bit(TTY_IO_ERROR, &tty->flags);
647 
648 	info->tport.flags &= ~ASYNC_INITIALIZED;
649 	local_irq_restore(flags);
650 }
651 
652 
653 /*
654  * This routine is called to set the UART divisor registers to match
655  * the specified baud rate for a serial port.
656  */
657 static void change_speed(struct tty_struct *tty, struct serial_state *info,
658 			 struct ktermios *old_termios)
659 {
660 	struct tty_port *port = &info->tport;
661 	int	quot = 0, baud_base, baud;
662 	unsigned cflag, cval = 0;
663 	int	bits;
664 	unsigned long	flags;
665 
666 	cflag = tty->termios.c_cflag;
667 
668 	/* Byte size is always 8 bits plus parity bit if requested */
669 
670 	cval = 3; bits = 10;
671 	if (cflag & CSTOPB) {
672 		cval |= 0x04;
673 		bits++;
674 	}
675 	if (cflag & PARENB) {
676 		cval |= UART_LCR_PARITY;
677 		bits++;
678 	}
679 	if (!(cflag & PARODD))
680 		cval |= UART_LCR_EPAR;
681 #ifdef CMSPAR
682 	if (cflag & CMSPAR)
683 		cval |= UART_LCR_SPAR;
684 #endif
685 
686 	/* Determine divisor based on baud rate */
687 	baud = tty_get_baud_rate(tty);
688 	if (!baud)
689 		baud = 9600;	/* B0 transition handled in rs_set_termios */
690 	baud_base = info->baud_base;
691 	if (baud == 38400 && (port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
692 		quot = info->custom_divisor;
693 	else {
694 		if (baud == 134)
695 			/* Special case since 134 is really 134.5 */
696 			quot = (2*baud_base / 269);
697 		else if (baud)
698 			quot = baud_base / baud;
699 	}
700 	/* If the quotient is zero refuse the change */
701 	if (!quot && old_termios) {
702 		/* FIXME: Will need updating for new tty in the end */
703 		tty->termios.c_cflag &= ~CBAUD;
704 		tty->termios.c_cflag |= (old_termios->c_cflag & CBAUD);
705 		baud = tty_get_baud_rate(tty);
706 		if (!baud)
707 			baud = 9600;
708 		if (baud == 38400 &&
709 		    (port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)
710 			quot = info->custom_divisor;
711 		else {
712 			if (baud == 134)
713 				/* Special case since 134 is really 134.5 */
714 				quot = (2*baud_base / 269);
715 			else if (baud)
716 				quot = baud_base / baud;
717 		}
718 	}
719 	/* As a last resort, if the quotient is zero, default to 9600 bps */
720 	if (!quot)
721 		quot = baud_base / 9600;
722 	info->quot = quot;
723 	info->timeout = ((info->xmit_fifo_size*HZ*bits*quot) / baud_base);
724 	info->timeout += HZ/50;		/* Add .02 seconds of slop */
725 
726 	/* CTS flow control flag and modem status interrupts */
727 	info->IER &= ~UART_IER_MSI;
728 	if (port->flags & ASYNC_HARDPPS_CD)
729 		info->IER |= UART_IER_MSI;
730 	if (cflag & CRTSCTS) {
731 		port->flags |= ASYNC_CTS_FLOW;
732 		info->IER |= UART_IER_MSI;
733 	} else
734 		port->flags &= ~ASYNC_CTS_FLOW;
735 	if (cflag & CLOCAL)
736 		port->flags &= ~ASYNC_CHECK_CD;
737 	else {
738 		port->flags |= ASYNC_CHECK_CD;
739 		info->IER |= UART_IER_MSI;
740 	}
741 	/* TBD:
742 	 * Does clearing IER_MSI imply that we should disable the VBL interrupt ?
743 	 */
744 
745 	/*
746 	 * Set up parity check flag
747 	 */
748 
749 	info->read_status_mask = UART_LSR_OE | UART_LSR_DR;
750 	if (I_INPCK(tty))
751 		info->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
752 	if (I_BRKINT(tty) || I_PARMRK(tty))
753 		info->read_status_mask |= UART_LSR_BI;
754 
755 	/*
756 	 * Characters to ignore
757 	 */
758 	info->ignore_status_mask = 0;
759 	if (I_IGNPAR(tty))
760 		info->ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
761 	if (I_IGNBRK(tty)) {
762 		info->ignore_status_mask |= UART_LSR_BI;
763 		/*
764 		 * If we're ignore parity and break indicators, ignore
765 		 * overruns too.  (For real raw support).
766 		 */
767 		if (I_IGNPAR(tty))
768 			info->ignore_status_mask |= UART_LSR_OE;
769 	}
770 	/*
771 	 * !!! ignore all characters if CREAD is not set
772 	 */
773 	if ((cflag & CREAD) == 0)
774 		info->ignore_status_mask |= UART_LSR_DR;
775 	local_irq_save(flags);
776 
777 	{
778 	  short serper;
779 
780 	/* Set up the baud rate */
781 	  serper = quot - 1;
782 
783 	/* Enable or disable parity bit */
784 
785 	if(cval & UART_LCR_PARITY)
786 	  serper |= (SERPER_PARENB);
787 
788 	custom.serper = serper;
789 	mb();
790 	}
791 
792 	local_irq_restore(flags);
793 }
794 
795 static int rs_put_char(struct tty_struct *tty, unsigned char ch)
796 {
797 	struct serial_state *info;
798 	unsigned long flags;
799 
800 	info = tty->driver_data;
801 
802 	if (serial_paranoia_check(info, tty->name, "rs_put_char"))
803 		return 0;
804 
805 	if (!info->xmit.buf)
806 		return 0;
807 
808 	local_irq_save(flags);
809 	if (CIRC_SPACE(info->xmit.head,
810 		       info->xmit.tail,
811 		       SERIAL_XMIT_SIZE) == 0) {
812 		local_irq_restore(flags);
813 		return 0;
814 	}
815 
816 	info->xmit.buf[info->xmit.head++] = ch;
817 	info->xmit.head &= SERIAL_XMIT_SIZE-1;
818 	local_irq_restore(flags);
819 	return 1;
820 }
821 
822 static void rs_flush_chars(struct tty_struct *tty)
823 {
824 	struct serial_state *info = tty->driver_data;
825 	unsigned long flags;
826 
827 	if (serial_paranoia_check(info, tty->name, "rs_flush_chars"))
828 		return;
829 
830 	if (info->xmit.head == info->xmit.tail
831 	    || tty->stopped
832 	    || tty->hw_stopped
833 	    || !info->xmit.buf)
834 		return;
835 
836 	local_irq_save(flags);
837 	info->IER |= UART_IER_THRI;
838 	custom.intena = IF_SETCLR | IF_TBE;
839 	mb();
840 	/* set a pending Tx Interrupt, transmitter should restart now */
841 	custom.intreq = IF_SETCLR | IF_TBE;
842 	mb();
843 	local_irq_restore(flags);
844 }
845 
846 static int rs_write(struct tty_struct * tty, const unsigned char *buf, int count)
847 {
848 	int	c, ret = 0;
849 	struct serial_state *info = tty->driver_data;
850 	unsigned long flags;
851 
852 	if (serial_paranoia_check(info, tty->name, "rs_write"))
853 		return 0;
854 
855 	if (!info->xmit.buf)
856 		return 0;
857 
858 	local_irq_save(flags);
859 	while (1) {
860 		c = CIRC_SPACE_TO_END(info->xmit.head,
861 				      info->xmit.tail,
862 				      SERIAL_XMIT_SIZE);
863 		if (count < c)
864 			c = count;
865 		if (c <= 0) {
866 			break;
867 		}
868 		memcpy(info->xmit.buf + info->xmit.head, buf, c);
869 		info->xmit.head = ((info->xmit.head + c) &
870 				   (SERIAL_XMIT_SIZE-1));
871 		buf += c;
872 		count -= c;
873 		ret += c;
874 	}
875 	local_irq_restore(flags);
876 
877 	if (info->xmit.head != info->xmit.tail
878 	    && !tty->stopped
879 	    && !tty->hw_stopped
880 	    && !(info->IER & UART_IER_THRI)) {
881 		info->IER |= UART_IER_THRI;
882 		local_irq_disable();
883 		custom.intena = IF_SETCLR | IF_TBE;
884 		mb();
885 		/* set a pending Tx Interrupt, transmitter should restart now */
886 		custom.intreq = IF_SETCLR | IF_TBE;
887 		mb();
888 		local_irq_restore(flags);
889 	}
890 	return ret;
891 }
892 
893 static int rs_write_room(struct tty_struct *tty)
894 {
895 	struct serial_state *info = tty->driver_data;
896 
897 	if (serial_paranoia_check(info, tty->name, "rs_write_room"))
898 		return 0;
899 	return CIRC_SPACE(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE);
900 }
901 
902 static int rs_chars_in_buffer(struct tty_struct *tty)
903 {
904 	struct serial_state *info = tty->driver_data;
905 
906 	if (serial_paranoia_check(info, tty->name, "rs_chars_in_buffer"))
907 		return 0;
908 	return CIRC_CNT(info->xmit.head, info->xmit.tail, SERIAL_XMIT_SIZE);
909 }
910 
911 static void rs_flush_buffer(struct tty_struct *tty)
912 {
913 	struct serial_state *info = tty->driver_data;
914 	unsigned long flags;
915 
916 	if (serial_paranoia_check(info, tty->name, "rs_flush_buffer"))
917 		return;
918 	local_irq_save(flags);
919 	info->xmit.head = info->xmit.tail = 0;
920 	local_irq_restore(flags);
921 	tty_wakeup(tty);
922 }
923 
924 /*
925  * This function is used to send a high-priority XON/XOFF character to
926  * the device
927  */
928 static void rs_send_xchar(struct tty_struct *tty, char ch)
929 {
930 	struct serial_state *info = tty->driver_data;
931         unsigned long flags;
932 
933 	if (serial_paranoia_check(info, tty->name, "rs_send_xchar"))
934 		return;
935 
936 	info->x_char = ch;
937 	if (ch) {
938 		/* Make sure transmit interrupts are on */
939 
940 	        /* Check this ! */
941 	        local_irq_save(flags);
942 		if(!(custom.intenar & IF_TBE)) {
943 		    custom.intena = IF_SETCLR | IF_TBE;
944 		    mb();
945 		    /* set a pending Tx Interrupt, transmitter should restart now */
946 		    custom.intreq = IF_SETCLR | IF_TBE;
947 		    mb();
948 		}
949 		local_irq_restore(flags);
950 
951 		info->IER |= UART_IER_THRI;
952 	}
953 }
954 
955 /*
956  * ------------------------------------------------------------
957  * rs_throttle()
958  *
959  * This routine is called by the upper-layer tty layer to signal that
960  * incoming characters should be throttled.
961  * ------------------------------------------------------------
962  */
963 static void rs_throttle(struct tty_struct * tty)
964 {
965 	struct serial_state *info = tty->driver_data;
966 	unsigned long flags;
967 #ifdef SERIAL_DEBUG_THROTTLE
968 	printk("throttle %s: %d....\n", tty_name(tty),
969 	       tty->ldisc.chars_in_buffer(tty));
970 #endif
971 
972 	if (serial_paranoia_check(info, tty->name, "rs_throttle"))
973 		return;
974 
975 	if (I_IXOFF(tty))
976 		rs_send_xchar(tty, STOP_CHAR(tty));
977 
978 	if (tty->termios.c_cflag & CRTSCTS)
979 		info->MCR &= ~SER_RTS;
980 
981 	local_irq_save(flags);
982 	rtsdtr_ctrl(info->MCR);
983 	local_irq_restore(flags);
984 }
985 
986 static void rs_unthrottle(struct tty_struct * tty)
987 {
988 	struct serial_state *info = tty->driver_data;
989 	unsigned long flags;
990 #ifdef SERIAL_DEBUG_THROTTLE
991 	printk("unthrottle %s: %d....\n", tty_name(tty),
992 	       tty->ldisc.chars_in_buffer(tty));
993 #endif
994 
995 	if (serial_paranoia_check(info, tty->name, "rs_unthrottle"))
996 		return;
997 
998 	if (I_IXOFF(tty)) {
999 		if (info->x_char)
1000 			info->x_char = 0;
1001 		else
1002 			rs_send_xchar(tty, START_CHAR(tty));
1003 	}
1004 	if (tty->termios.c_cflag & CRTSCTS)
1005 		info->MCR |= SER_RTS;
1006 	local_irq_save(flags);
1007 	rtsdtr_ctrl(info->MCR);
1008 	local_irq_restore(flags);
1009 }
1010 
1011 /*
1012  * ------------------------------------------------------------
1013  * rs_ioctl() and friends
1014  * ------------------------------------------------------------
1015  */
1016 
1017 static int get_serial_info(struct tty_struct *tty, struct serial_state *state,
1018 			   struct serial_struct __user * retinfo)
1019 {
1020 	struct serial_struct tmp;
1021 
1022 	if (!retinfo)
1023 		return -EFAULT;
1024 	memset(&tmp, 0, sizeof(tmp));
1025 	tty_lock(tty);
1026 	tmp.line = tty->index;
1027 	tmp.port = state->port;
1028 	tmp.flags = state->tport.flags;
1029 	tmp.xmit_fifo_size = state->xmit_fifo_size;
1030 	tmp.baud_base = state->baud_base;
1031 	tmp.close_delay = state->tport.close_delay;
1032 	tmp.closing_wait = state->tport.closing_wait;
1033 	tmp.custom_divisor = state->custom_divisor;
1034 	tty_unlock(tty);
1035 	if (copy_to_user(retinfo,&tmp,sizeof(*retinfo)))
1036 		return -EFAULT;
1037 	return 0;
1038 }
1039 
1040 static int set_serial_info(struct tty_struct *tty, struct serial_state *state,
1041 			   struct serial_struct __user * new_info)
1042 {
1043 	struct tty_port *port = &state->tport;
1044 	struct serial_struct new_serial;
1045 	bool change_spd;
1046 	int 			retval = 0;
1047 
1048 	if (copy_from_user(&new_serial,new_info,sizeof(new_serial)))
1049 		return -EFAULT;
1050 
1051 	tty_lock(tty);
1052 	change_spd = ((new_serial.flags ^ port->flags) & ASYNC_SPD_MASK) ||
1053 		new_serial.custom_divisor != state->custom_divisor;
1054 	if (new_serial.irq || new_serial.port != state->port ||
1055 			new_serial.xmit_fifo_size != state->xmit_fifo_size) {
1056 		tty_unlock(tty);
1057 		return -EINVAL;
1058 	}
1059 
1060 	if (!serial_isroot()) {
1061 		if ((new_serial.baud_base != state->baud_base) ||
1062 		    (new_serial.close_delay != port->close_delay) ||
1063 		    (new_serial.xmit_fifo_size != state->xmit_fifo_size) ||
1064 		    ((new_serial.flags & ~ASYNC_USR_MASK) !=
1065 		     (port->flags & ~ASYNC_USR_MASK))) {
1066 			tty_unlock(tty);
1067 			return -EPERM;
1068 		}
1069 		port->flags = ((port->flags & ~ASYNC_USR_MASK) |
1070 			       (new_serial.flags & ASYNC_USR_MASK));
1071 		state->custom_divisor = new_serial.custom_divisor;
1072 		goto check_and_exit;
1073 	}
1074 
1075 	if (new_serial.baud_base < 9600) {
1076 		tty_unlock(tty);
1077 		return -EINVAL;
1078 	}
1079 
1080 	/*
1081 	 * OK, past this point, all the error checking has been done.
1082 	 * At this point, we start making changes.....
1083 	 */
1084 
1085 	state->baud_base = new_serial.baud_base;
1086 	port->flags = ((port->flags & ~ASYNC_FLAGS) |
1087 			(new_serial.flags & ASYNC_FLAGS));
1088 	state->custom_divisor = new_serial.custom_divisor;
1089 	port->close_delay = new_serial.close_delay * HZ/100;
1090 	port->closing_wait = new_serial.closing_wait * HZ/100;
1091 	port->low_latency = (port->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1092 
1093 check_and_exit:
1094 	if (port->flags & ASYNC_INITIALIZED) {
1095 		if (change_spd) {
1096 			if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
1097 				tty->alt_speed = 57600;
1098 			if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
1099 				tty->alt_speed = 115200;
1100 			if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
1101 				tty->alt_speed = 230400;
1102 			if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
1103 				tty->alt_speed = 460800;
1104 			change_speed(tty, state, NULL);
1105 		}
1106 	} else
1107 		retval = startup(tty, state);
1108 	tty_unlock(tty);
1109 	return retval;
1110 }
1111 
1112 
1113 /*
1114  * get_lsr_info - get line status register info
1115  *
1116  * Purpose: Let user call ioctl() to get info when the UART physically
1117  * 	    is emptied.  On bus types like RS485, the transmitter must
1118  * 	    release the bus after transmitting. This must be done when
1119  * 	    the transmit shift register is empty, not be done when the
1120  * 	    transmit holding register is empty.  This functionality
1121  * 	    allows an RS485 driver to be written in user space.
1122  */
1123 static int get_lsr_info(struct serial_state *info, unsigned int __user *value)
1124 {
1125 	unsigned char status;
1126 	unsigned int result;
1127 	unsigned long flags;
1128 
1129 	local_irq_save(flags);
1130 	status = custom.serdatr;
1131 	mb();
1132 	local_irq_restore(flags);
1133 	result = ((status & SDR_TSRE) ? TIOCSER_TEMT : 0);
1134 	if (copy_to_user(value, &result, sizeof(int)))
1135 		return -EFAULT;
1136 	return 0;
1137 }
1138 
1139 
1140 static int rs_tiocmget(struct tty_struct *tty)
1141 {
1142 	struct serial_state *info = tty->driver_data;
1143 	unsigned char control, status;
1144 	unsigned long flags;
1145 
1146 	if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1147 		return -ENODEV;
1148 	if (tty->flags & (1 << TTY_IO_ERROR))
1149 		return -EIO;
1150 
1151 	control = info->MCR;
1152 	local_irq_save(flags);
1153 	status = ciab.pra;
1154 	local_irq_restore(flags);
1155 	return    ((control & SER_RTS) ? TIOCM_RTS : 0)
1156 		| ((control & SER_DTR) ? TIOCM_DTR : 0)
1157 		| (!(status  & SER_DCD) ? TIOCM_CAR : 0)
1158 		| (!(status  & SER_DSR) ? TIOCM_DSR : 0)
1159 		| (!(status  & SER_CTS) ? TIOCM_CTS : 0);
1160 }
1161 
1162 static int rs_tiocmset(struct tty_struct *tty, unsigned int set,
1163 						unsigned int clear)
1164 {
1165 	struct serial_state *info = tty->driver_data;
1166 	unsigned long flags;
1167 
1168 	if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1169 		return -ENODEV;
1170 	if (tty->flags & (1 << TTY_IO_ERROR))
1171 		return -EIO;
1172 
1173 	local_irq_save(flags);
1174 	if (set & TIOCM_RTS)
1175 		info->MCR |= SER_RTS;
1176 	if (set & TIOCM_DTR)
1177 		info->MCR |= SER_DTR;
1178 	if (clear & TIOCM_RTS)
1179 		info->MCR &= ~SER_RTS;
1180 	if (clear & TIOCM_DTR)
1181 		info->MCR &= ~SER_DTR;
1182 	rtsdtr_ctrl(info->MCR);
1183 	local_irq_restore(flags);
1184 	return 0;
1185 }
1186 
1187 /*
1188  * rs_break() --- routine which turns the break handling on or off
1189  */
1190 static int rs_break(struct tty_struct *tty, int break_state)
1191 {
1192 	struct serial_state *info = tty->driver_data;
1193 	unsigned long flags;
1194 
1195 	if (serial_paranoia_check(info, tty->name, "rs_break"))
1196 		return -EINVAL;
1197 
1198 	local_irq_save(flags);
1199 	if (break_state == -1)
1200 	  custom.adkcon = AC_SETCLR | AC_UARTBRK;
1201 	else
1202 	  custom.adkcon = AC_UARTBRK;
1203 	mb();
1204 	local_irq_restore(flags);
1205 	return 0;
1206 }
1207 
1208 /*
1209  * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
1210  * Return: write counters to the user passed counter struct
1211  * NB: both 1->0 and 0->1 transitions are counted except for
1212  *     RI where only 0->1 is counted.
1213  */
1214 static int rs_get_icount(struct tty_struct *tty,
1215 				struct serial_icounter_struct *icount)
1216 {
1217 	struct serial_state *info = tty->driver_data;
1218 	struct async_icount cnow;
1219 	unsigned long flags;
1220 
1221 	local_irq_save(flags);
1222 	cnow = info->icount;
1223 	local_irq_restore(flags);
1224 	icount->cts = cnow.cts;
1225 	icount->dsr = cnow.dsr;
1226 	icount->rng = cnow.rng;
1227 	icount->dcd = cnow.dcd;
1228 	icount->rx = cnow.rx;
1229 	icount->tx = cnow.tx;
1230 	icount->frame = cnow.frame;
1231 	icount->overrun = cnow.overrun;
1232 	icount->parity = cnow.parity;
1233 	icount->brk = cnow.brk;
1234 	icount->buf_overrun = cnow.buf_overrun;
1235 
1236 	return 0;
1237 }
1238 
1239 static int rs_ioctl(struct tty_struct *tty,
1240 		    unsigned int cmd, unsigned long arg)
1241 {
1242 	struct serial_state *info = tty->driver_data;
1243 	struct async_icount cprev, cnow;	/* kernel counter temps */
1244 	void __user *argp = (void __user *)arg;
1245 	unsigned long flags;
1246 	DEFINE_WAIT(wait);
1247 	int ret;
1248 
1249 	if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1250 		return -ENODEV;
1251 
1252 	if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1253 	    (cmd != TIOCSERCONFIG) && (cmd != TIOCSERGSTRUCT) &&
1254 	    (cmd != TIOCMIWAIT) && (cmd != TIOCGICOUNT)) {
1255 		if (tty->flags & (1 << TTY_IO_ERROR))
1256 		    return -EIO;
1257 	}
1258 
1259 	switch (cmd) {
1260 		case TIOCGSERIAL:
1261 			return get_serial_info(tty, info, argp);
1262 		case TIOCSSERIAL:
1263 			return set_serial_info(tty, info, argp);
1264 		case TIOCSERCONFIG:
1265 			return 0;
1266 
1267 		case TIOCSERGETLSR: /* Get line status register */
1268 			return get_lsr_info(info, argp);
1269 
1270 		case TIOCSERGSTRUCT:
1271 			if (copy_to_user(argp,
1272 					 info, sizeof(struct serial_state)))
1273 				return -EFAULT;
1274 			return 0;
1275 
1276 		/*
1277 		 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
1278 		 * - mask passed in arg for lines of interest
1279  		 *   (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
1280 		 * Caller should use TIOCGICOUNT to see which one it was
1281 		 */
1282 		case TIOCMIWAIT:
1283 			local_irq_save(flags);
1284 			/* note the counters on entry */
1285 			cprev = info->icount;
1286 			local_irq_restore(flags);
1287 			while (1) {
1288 				prepare_to_wait(&info->tport.delta_msr_wait,
1289 						&wait, TASK_INTERRUPTIBLE);
1290 				local_irq_save(flags);
1291 				cnow = info->icount; /* atomic copy */
1292 				local_irq_restore(flags);
1293 				if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
1294 				    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) {
1295 					ret = -EIO; /* no change => error */
1296 					break;
1297 				}
1298 				if ( ((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
1299 				     ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
1300 				     ((arg & TIOCM_CD)  && (cnow.dcd != cprev.dcd)) ||
1301 				     ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
1302 					ret = 0;
1303 					break;
1304 				}
1305 				schedule();
1306 				/* see if a signal did it */
1307 				if (signal_pending(current)) {
1308 					ret = -ERESTARTSYS;
1309 					break;
1310 				}
1311 				cprev = cnow;
1312 			}
1313 			finish_wait(&info->tport.delta_msr_wait, &wait);
1314 			return ret;
1315 
1316 		case TIOCSERGWILD:
1317 		case TIOCSERSWILD:
1318 			/* "setserial -W" is called in Debian boot */
1319 			printk ("TIOCSER?WILD ioctl obsolete, ignored.\n");
1320 			return 0;
1321 
1322 		default:
1323 			return -ENOIOCTLCMD;
1324 		}
1325 	return 0;
1326 }
1327 
1328 static void rs_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
1329 {
1330 	struct serial_state *info = tty->driver_data;
1331 	unsigned long flags;
1332 	unsigned int cflag = tty->termios.c_cflag;
1333 
1334 	change_speed(tty, info, old_termios);
1335 
1336 	/* Handle transition to B0 status */
1337 	if ((old_termios->c_cflag & CBAUD) &&
1338 	    !(cflag & CBAUD)) {
1339 		info->MCR &= ~(SER_DTR|SER_RTS);
1340 		local_irq_save(flags);
1341 		rtsdtr_ctrl(info->MCR);
1342 		local_irq_restore(flags);
1343 	}
1344 
1345 	/* Handle transition away from B0 status */
1346 	if (!(old_termios->c_cflag & CBAUD) &&
1347 	    (cflag & CBAUD)) {
1348 		info->MCR |= SER_DTR;
1349 		if (!(tty->termios.c_cflag & CRTSCTS) ||
1350 		    !test_bit(TTY_THROTTLED, &tty->flags)) {
1351 			info->MCR |= SER_RTS;
1352 		}
1353 		local_irq_save(flags);
1354 		rtsdtr_ctrl(info->MCR);
1355 		local_irq_restore(flags);
1356 	}
1357 
1358 	/* Handle turning off CRTSCTS */
1359 	if ((old_termios->c_cflag & CRTSCTS) &&
1360 	    !(tty->termios.c_cflag & CRTSCTS)) {
1361 		tty->hw_stopped = 0;
1362 		rs_start(tty);
1363 	}
1364 
1365 #if 0
1366 	/*
1367 	 * No need to wake up processes in open wait, since they
1368 	 * sample the CLOCAL flag once, and don't recheck it.
1369 	 * XXX  It's not clear whether the current behavior is correct
1370 	 * or not.  Hence, this may change.....
1371 	 */
1372 	if (!(old_termios->c_cflag & CLOCAL) &&
1373 	    (tty->termios.c_cflag & CLOCAL))
1374 		wake_up_interruptible(&info->open_wait);
1375 #endif
1376 }
1377 
1378 /*
1379  * ------------------------------------------------------------
1380  * rs_close()
1381  *
1382  * This routine is called when the serial port gets closed.  First, we
1383  * wait for the last remaining data to be sent.  Then, we unlink its
1384  * async structure from the interrupt chain if necessary, and we free
1385  * that IRQ if nothing is left in the chain.
1386  * ------------------------------------------------------------
1387  */
1388 static void rs_close(struct tty_struct *tty, struct file * filp)
1389 {
1390 	struct serial_state *state = tty->driver_data;
1391 	struct tty_port *port = &state->tport;
1392 
1393 	if (serial_paranoia_check(state, tty->name, "rs_close"))
1394 		return;
1395 
1396 	if (tty_port_close_start(port, tty, filp) == 0)
1397 		return;
1398 
1399 	/*
1400 	 * At this point we stop accepting input.  To do this, we
1401 	 * disable the receive line status interrupts, and tell the
1402 	 * interrupt driver to stop checking the data ready bit in the
1403 	 * line status register.
1404 	 */
1405 	state->read_status_mask &= ~UART_LSR_DR;
1406 	if (port->flags & ASYNC_INITIALIZED) {
1407 	        /* disable receive interrupts */
1408 	        custom.intena = IF_RBF;
1409 		mb();
1410 		/* clear any pending receive interrupt */
1411 		custom.intreq = IF_RBF;
1412 		mb();
1413 
1414 		/*
1415 		 * Before we drop DTR, make sure the UART transmitter
1416 		 * has completely drained; this is especially
1417 		 * important if there is a transmit FIFO!
1418 		 */
1419 		rs_wait_until_sent(tty, state->timeout);
1420 	}
1421 	shutdown(tty, state);
1422 	rs_flush_buffer(tty);
1423 
1424 	tty_ldisc_flush(tty);
1425 	port->tty = NULL;
1426 
1427 	tty_port_close_end(port, tty);
1428 }
1429 
1430 /*
1431  * rs_wait_until_sent() --- wait until the transmitter is empty
1432  */
1433 static void rs_wait_until_sent(struct tty_struct *tty, int timeout)
1434 {
1435 	struct serial_state *info = tty->driver_data;
1436 	unsigned long orig_jiffies, char_time;
1437 	int lsr;
1438 
1439 	if (serial_paranoia_check(info, tty->name, "rs_wait_until_sent"))
1440 		return;
1441 
1442 	if (info->xmit_fifo_size == 0)
1443 		return; /* Just in case.... */
1444 
1445 	orig_jiffies = jiffies;
1446 
1447 	/*
1448 	 * Set the check interval to be 1/5 of the estimated time to
1449 	 * send a single character, and make it at least 1.  The check
1450 	 * interval should also be less than the timeout.
1451 	 *
1452 	 * Note: we have to use pretty tight timings here to satisfy
1453 	 * the NIST-PCTS.
1454 	 */
1455 	char_time = (info->timeout - HZ/50) / info->xmit_fifo_size;
1456 	char_time = char_time / 5;
1457 	if (char_time == 0)
1458 		char_time = 1;
1459 	if (timeout)
1460 	  char_time = min_t(unsigned long, char_time, timeout);
1461 	/*
1462 	 * If the transmitter hasn't cleared in twice the approximate
1463 	 * amount of time to send the entire FIFO, it probably won't
1464 	 * ever clear.  This assumes the UART isn't doing flow
1465 	 * control, which is currently the case.  Hence, if it ever
1466 	 * takes longer than info->timeout, this is probably due to a
1467 	 * UART bug of some kind.  So, we clamp the timeout parameter at
1468 	 * 2*info->timeout.
1469 	 */
1470 	if (!timeout || timeout > 2*info->timeout)
1471 		timeout = 2*info->timeout;
1472 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1473 	printk("In rs_wait_until_sent(%d) check=%lu...", timeout, char_time);
1474 	printk("jiff=%lu...", jiffies);
1475 #endif
1476 	while(!((lsr = custom.serdatr) & SDR_TSRE)) {
1477 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1478 		printk("serdatr = %d (jiff=%lu)...", lsr, jiffies);
1479 #endif
1480 		msleep_interruptible(jiffies_to_msecs(char_time));
1481 		if (signal_pending(current))
1482 			break;
1483 		if (timeout && time_after(jiffies, orig_jiffies + timeout))
1484 			break;
1485 	}
1486 	__set_current_state(TASK_RUNNING);
1487 
1488 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1489 	printk("lsr = %d (jiff=%lu)...done\n", lsr, jiffies);
1490 #endif
1491 }
1492 
1493 /*
1494  * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1495  */
1496 static void rs_hangup(struct tty_struct *tty)
1497 {
1498 	struct serial_state *info = tty->driver_data;
1499 
1500 	if (serial_paranoia_check(info, tty->name, "rs_hangup"))
1501 		return;
1502 
1503 	rs_flush_buffer(tty);
1504 	shutdown(tty, info);
1505 	info->tport.count = 0;
1506 	info->tport.flags &= ~ASYNC_NORMAL_ACTIVE;
1507 	info->tport.tty = NULL;
1508 	wake_up_interruptible(&info->tport.open_wait);
1509 }
1510 
1511 /*
1512  * This routine is called whenever a serial port is opened.  It
1513  * enables interrupts for a serial port, linking in its async structure into
1514  * the IRQ chain.   It also performs the serial-specific
1515  * initialization for the tty structure.
1516  */
1517 static int rs_open(struct tty_struct *tty, struct file * filp)
1518 {
1519 	struct serial_state *info = rs_table + tty->index;
1520 	struct tty_port *port = &info->tport;
1521 	int retval;
1522 
1523 	port->count++;
1524 	port->tty = tty;
1525 	tty->driver_data = info;
1526 	tty->port = port;
1527 	if (serial_paranoia_check(info, tty->name, "rs_open"))
1528 		return -ENODEV;
1529 
1530 	port->low_latency = (port->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1531 
1532 	retval = startup(tty, info);
1533 	if (retval) {
1534 		return retval;
1535 	}
1536 
1537 	return tty_port_block_til_ready(port, tty, filp);
1538 }
1539 
1540 /*
1541  * /proc fs routines....
1542  */
1543 
1544 static inline void line_info(struct seq_file *m, int line,
1545 		struct serial_state *state)
1546 {
1547 	char	stat_buf[30], control, status;
1548 	unsigned long flags;
1549 
1550 	seq_printf(m, "%d: uart:amiga_builtin", line);
1551 
1552 	local_irq_save(flags);
1553 	status = ciab.pra;
1554 	control = (state->tport.flags & ASYNC_INITIALIZED) ? state->MCR : status;
1555 	local_irq_restore(flags);
1556 
1557 	stat_buf[0] = 0;
1558 	stat_buf[1] = 0;
1559 	if(!(control & SER_RTS))
1560 		strcat(stat_buf, "|RTS");
1561 	if(!(status & SER_CTS))
1562 		strcat(stat_buf, "|CTS");
1563 	if(!(control & SER_DTR))
1564 		strcat(stat_buf, "|DTR");
1565 	if(!(status & SER_DSR))
1566 		strcat(stat_buf, "|DSR");
1567 	if(!(status & SER_DCD))
1568 		strcat(stat_buf, "|CD");
1569 
1570 	if (state->quot)
1571 		seq_printf(m, " baud:%d", state->baud_base / state->quot);
1572 
1573 	seq_printf(m, " tx:%d rx:%d", state->icount.tx, state->icount.rx);
1574 
1575 	if (state->icount.frame)
1576 		seq_printf(m, " fe:%d", state->icount.frame);
1577 
1578 	if (state->icount.parity)
1579 		seq_printf(m, " pe:%d", state->icount.parity);
1580 
1581 	if (state->icount.brk)
1582 		seq_printf(m, " brk:%d", state->icount.brk);
1583 
1584 	if (state->icount.overrun)
1585 		seq_printf(m, " oe:%d", state->icount.overrun);
1586 
1587 	/*
1588 	 * Last thing is the RS-232 status lines
1589 	 */
1590 	seq_printf(m, " %s\n", stat_buf+1);
1591 }
1592 
1593 static int rs_proc_show(struct seq_file *m, void *v)
1594 {
1595 	seq_printf(m, "serinfo:1.0 driver:%s\n", serial_version);
1596 	line_info(m, 0, &rs_table[0]);
1597 	return 0;
1598 }
1599 
1600 static int rs_proc_open(struct inode *inode, struct file *file)
1601 {
1602 	return single_open(file, rs_proc_show, NULL);
1603 }
1604 
1605 static const struct file_operations rs_proc_fops = {
1606 	.owner		= THIS_MODULE,
1607 	.open		= rs_proc_open,
1608 	.read		= seq_read,
1609 	.llseek		= seq_lseek,
1610 	.release	= single_release,
1611 };
1612 
1613 /*
1614  * ---------------------------------------------------------------------
1615  * rs_init() and friends
1616  *
1617  * rs_init() is called at boot-time to initialize the serial driver.
1618  * ---------------------------------------------------------------------
1619  */
1620 
1621 /*
1622  * This routine prints out the appropriate serial driver version
1623  * number, and identifies which options were configured into this
1624  * driver.
1625  */
1626 static void show_serial_version(void)
1627 {
1628  	printk(KERN_INFO "%s version %s\n", serial_name, serial_version);
1629 }
1630 
1631 
1632 static const struct tty_operations serial_ops = {
1633 	.open = rs_open,
1634 	.close = rs_close,
1635 	.write = rs_write,
1636 	.put_char = rs_put_char,
1637 	.flush_chars = rs_flush_chars,
1638 	.write_room = rs_write_room,
1639 	.chars_in_buffer = rs_chars_in_buffer,
1640 	.flush_buffer = rs_flush_buffer,
1641 	.ioctl = rs_ioctl,
1642 	.throttle = rs_throttle,
1643 	.unthrottle = rs_unthrottle,
1644 	.set_termios = rs_set_termios,
1645 	.stop = rs_stop,
1646 	.start = rs_start,
1647 	.hangup = rs_hangup,
1648 	.break_ctl = rs_break,
1649 	.send_xchar = rs_send_xchar,
1650 	.wait_until_sent = rs_wait_until_sent,
1651 	.tiocmget = rs_tiocmget,
1652 	.tiocmset = rs_tiocmset,
1653 	.get_icount = rs_get_icount,
1654 	.proc_fops = &rs_proc_fops,
1655 };
1656 
1657 static int amiga_carrier_raised(struct tty_port *port)
1658 {
1659 	return !(ciab.pra & SER_DCD);
1660 }
1661 
1662 static void amiga_dtr_rts(struct tty_port *port, int raise)
1663 {
1664 	struct serial_state *info = container_of(port, struct serial_state,
1665 			tport);
1666 	unsigned long flags;
1667 
1668 	if (raise)
1669 		info->MCR |= SER_DTR|SER_RTS;
1670 	else
1671 		info->MCR &= ~(SER_DTR|SER_RTS);
1672 
1673 	local_irq_save(flags);
1674 	rtsdtr_ctrl(info->MCR);
1675 	local_irq_restore(flags);
1676 }
1677 
1678 static const struct tty_port_operations amiga_port_ops = {
1679 	.carrier_raised = amiga_carrier_raised,
1680 	.dtr_rts = amiga_dtr_rts,
1681 };
1682 
1683 /*
1684  * The serial driver boot-time initialization code!
1685  */
1686 static int __init amiga_serial_probe(struct platform_device *pdev)
1687 {
1688 	unsigned long flags;
1689 	struct serial_state * state;
1690 	int error;
1691 
1692 	serial_driver = alloc_tty_driver(NR_PORTS);
1693 	if (!serial_driver)
1694 		return -ENOMEM;
1695 
1696 	show_serial_version();
1697 
1698 	/* Initialize the tty_driver structure */
1699 
1700 	serial_driver->driver_name = "amiserial";
1701 	serial_driver->name = "ttyS";
1702 	serial_driver->major = TTY_MAJOR;
1703 	serial_driver->minor_start = 64;
1704 	serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
1705 	serial_driver->subtype = SERIAL_TYPE_NORMAL;
1706 	serial_driver->init_termios = tty_std_termios;
1707 	serial_driver->init_termios.c_cflag =
1708 		B9600 | CS8 | CREAD | HUPCL | CLOCAL;
1709 	serial_driver->flags = TTY_DRIVER_REAL_RAW;
1710 	tty_set_operations(serial_driver, &serial_ops);
1711 
1712 	state = rs_table;
1713 	state->port = (int)&custom.serdatr; /* Just to give it a value */
1714 	state->custom_divisor = 0;
1715 	state->icount.cts = state->icount.dsr =
1716 	  state->icount.rng = state->icount.dcd = 0;
1717 	state->icount.rx = state->icount.tx = 0;
1718 	state->icount.frame = state->icount.parity = 0;
1719 	state->icount.overrun = state->icount.brk = 0;
1720 	tty_port_init(&state->tport);
1721 	state->tport.ops = &amiga_port_ops;
1722 	tty_port_link_device(&state->tport, serial_driver, 0);
1723 
1724 	error = tty_register_driver(serial_driver);
1725 	if (error)
1726 		goto fail_put_tty_driver;
1727 
1728 	printk(KERN_INFO "ttyS0 is the amiga builtin serial port\n");
1729 
1730 	/* Hardware set up */
1731 
1732 	state->baud_base = amiga_colorclock;
1733 	state->xmit_fifo_size = 1;
1734 
1735 	/* set ISRs, and then disable the rx interrupts */
1736 	error = request_irq(IRQ_AMIGA_TBE, ser_tx_int, 0, "serial TX", state);
1737 	if (error)
1738 		goto fail_unregister;
1739 
1740 	error = request_irq(IRQ_AMIGA_RBF, ser_rx_int, 0,
1741 			    "serial RX", state);
1742 	if (error)
1743 		goto fail_free_irq;
1744 
1745 	local_irq_save(flags);
1746 
1747 	/* turn off Rx and Tx interrupts */
1748 	custom.intena = IF_RBF | IF_TBE;
1749 	mb();
1750 
1751 	/* clear any pending interrupt */
1752 	custom.intreq = IF_RBF | IF_TBE;
1753 	mb();
1754 
1755 	local_irq_restore(flags);
1756 
1757 	/*
1758 	 * set the appropriate directions for the modem control flags,
1759 	 * and clear RTS and DTR
1760 	 */
1761 	ciab.ddra |= (SER_DTR | SER_RTS);   /* outputs */
1762 	ciab.ddra &= ~(SER_DCD | SER_CTS | SER_DSR);  /* inputs */
1763 
1764 	platform_set_drvdata(pdev, state);
1765 
1766 	return 0;
1767 
1768 fail_free_irq:
1769 	free_irq(IRQ_AMIGA_TBE, state);
1770 fail_unregister:
1771 	tty_unregister_driver(serial_driver);
1772 fail_put_tty_driver:
1773 	tty_port_destroy(&state->tport);
1774 	put_tty_driver(serial_driver);
1775 	return error;
1776 }
1777 
1778 static int __exit amiga_serial_remove(struct platform_device *pdev)
1779 {
1780 	int error;
1781 	struct serial_state *state = platform_get_drvdata(pdev);
1782 
1783 	/* printk("Unloading %s: version %s\n", serial_name, serial_version); */
1784 	error = tty_unregister_driver(serial_driver);
1785 	if (error)
1786 		printk("SERIAL: failed to unregister serial driver (%d)\n",
1787 		       error);
1788 	put_tty_driver(serial_driver);
1789 	tty_port_destroy(&state->tport);
1790 
1791 	free_irq(IRQ_AMIGA_TBE, state);
1792 	free_irq(IRQ_AMIGA_RBF, state);
1793 
1794 	return error;
1795 }
1796 
1797 static struct platform_driver amiga_serial_driver = {
1798 	.remove = __exit_p(amiga_serial_remove),
1799 	.driver   = {
1800 		.name	= "amiga-serial",
1801 	},
1802 };
1803 
1804 module_platform_driver_probe(amiga_serial_driver, amiga_serial_probe);
1805 
1806 
1807 #if defined(CONFIG_SERIAL_CONSOLE) && !defined(MODULE)
1808 
1809 /*
1810  * ------------------------------------------------------------
1811  * Serial console driver
1812  * ------------------------------------------------------------
1813  */
1814 
1815 static void amiga_serial_putc(char c)
1816 {
1817 	custom.serdat = (unsigned char)c | 0x100;
1818 	while (!(custom.serdatr & 0x2000))
1819 		barrier();
1820 }
1821 
1822 /*
1823  *	Print a string to the serial port trying not to disturb
1824  *	any possible real use of the port...
1825  *
1826  *	The console must be locked when we get here.
1827  */
1828 static void serial_console_write(struct console *co, const char *s,
1829 				unsigned count)
1830 {
1831 	unsigned short intena = custom.intenar;
1832 
1833 	custom.intena = IF_TBE;
1834 
1835 	while (count--) {
1836 		if (*s == '\n')
1837 			amiga_serial_putc('\r');
1838 		amiga_serial_putc(*s++);
1839 	}
1840 
1841 	custom.intena = IF_SETCLR | (intena & IF_TBE);
1842 }
1843 
1844 static struct tty_driver *serial_console_device(struct console *c, int *index)
1845 {
1846 	*index = 0;
1847 	return serial_driver;
1848 }
1849 
1850 static struct console sercons = {
1851 	.name =		"ttyS",
1852 	.write =	serial_console_write,
1853 	.device =	serial_console_device,
1854 	.flags =	CON_PRINTBUFFER,
1855 	.index =	-1,
1856 };
1857 
1858 /*
1859  *	Register console.
1860  */
1861 static int __init amiserial_console_init(void)
1862 {
1863 	if (!MACH_IS_AMIGA)
1864 		return -ENODEV;
1865 
1866 	register_console(&sercons);
1867 	return 0;
1868 }
1869 console_initcall(amiserial_console_init);
1870 
1871 #endif /* CONFIG_SERIAL_CONSOLE && !MODULE */
1872 
1873 MODULE_LICENSE("GPL");
1874 MODULE_ALIAS("platform:amiga-serial");
1875