PageRenderTime 97ms CodeModel.GetById 37ms app.highlight 46ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/tty/amiserial.c

https://bitbucket.org/wisechild/galaxy-nexus
C | 2176 lines | 1501 code | 300 blank | 375 comment | 311 complexity | 01b6291100683568ca1723f1d0b4c418 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0

Large files files are truncated, but you can click here to view the full file

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

Large files files are truncated, but you can click here to view the full file