AcoSail/kernel_optimize_test
8
0
Fork 0
forked from luck/tmp_suning_uos_patched
Code Pull Requests Activity
1a68f71d4f
kernel_optimize_test/drivers/sbus/char/aurora.c
David Howells 7d12e780e0 IRQ: Maintain regs pointer globally rather than passing to IRQ handlers 
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead
of passing regs around manually through all ~1800 interrupt handlers in the
Linux kernel.

The regs pointer is used in few places, but it potentially costs both stack
space and code to pass it around.  On the FRV arch, removing the regs parameter
from all the genirq function results in a 20% speed up of the IRQ exit path
(ie: from leaving timer_interrupt() to leaving do_IRQ()).

Where appropriate, an arch may override the generic storage facility and do
something different with the variable.  On FRV, for instance, the address is
maintained in GR28 at all times inside the kernel as part of general exception
handling.

Having looked over the code, it appears that the parameter may be handed down
through up to twenty or so layers of functions.  Consider a USB character
device attached to a USB hub, attached to a USB controller that posts its
interrupts through a cascaded auxiliary interrupt controller.  A character
device driver may want to pass regs to the sysrq handler through the input
layer which adds another few layers of parameter passing.

I've build this code with allyesconfig for x86_64 and i386.  I've runtested the
main part of the code on FRV and i386, though I can't test most of the drivers.
I've also done partial conversion for powerpc and MIPS - these at least compile
with minimal configurations.

This will affect all archs.  Mostly the changes should be relatively easy.
Take do_IRQ(), store the regs pointer at the beginning, saving the old one:

	struct pt_regs *old_regs = set_irq_regs(regs);

And put the old one back at the end:

	set_irq_regs(old_regs);

Don't pass regs through to generic_handle_irq() or __do_IRQ().

In timer_interrupt(), this sort of change will be necessary:

	-	update_process_times(user_mode(regs));
	-	profile_tick(CPU_PROFILING, regs);
	+	update_process_times(user_mode(get_irq_regs()));
	+	profile_tick(CPU_PROFILING);

I'd like to move update_process_times()'s use of get_irq_regs() into itself,
except that i386, alone of the archs, uses something other than user_mode().

Some notes on the interrupt handling in the drivers:

 (*) input_dev() is now gone entirely.  The regs pointer is no longer stored in
     the input_dev struct.

 (*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking.  It does
     something different depending on whether it's been supplied with a regs
     pointer or not.

 (*) Various IRQ handler function pointers have been moved to type
     irq_handler_t.

Signed-Off-By: David Howells <dhowells@redhat.com>
(cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 15:10:12 +01:00

2365 lines
59 KiB
C
Raw Blame History

/* $Id: aurora.c,v 1.19 2002/01/08 16:00:16 davem Exp $
* linux/drivers/sbus/char/aurora.c -- Aurora multiport driver
*
* Copyright (c) 1999 by Oliver Aldulea (oli at bv dot ro)
*
* This code is based on the RISCom/8 multiport serial driver written
* by Dmitry Gorodchanin (pgmdsg@ibi.com), based on the Linux serial
* driver, written by Linus Torvalds, Theodore T'so and others.
* The Aurora multiport programming info was obtained mainly from the
* Cirrus Logic CD180 documentation (available on the web), and by
* doing heavy tests on the board. Many thanks to Eddie C. Dost for the
* help on the sbus interface.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* Revision 1.0
*
* This is the first public release.
*
* Most of the information you need is in the aurora.h file. Please
* read that file before reading this one.
*
* Several parts of the code do not have comments yet.
*
* n.b. The board can support 115.2 bit rates, but only on a few
* ports. The total badwidth of one chip (ports 0-7 or 8-15) is equal
* to OSC_FREQ div 16. In case of my board, each chip can take 6
* channels of 115.2 kbaud. This information is not well-tested.
*
* Fixed to use tty_get_baud_rate().
* Theodore Ts'o <tytso@mit.edu>, 2001-Oct-12
*/
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/sched.h>
#ifdef AURORA_INT_DEBUG
#include <linux/timer.h>
#endif
#include <linux/interrupt.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/fcntl.h>
#include <linux/mm.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/bitops.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/oplib.h>
#include <asm/system.h>
#include <asm/kdebug.h>
#include <asm/sbus.h>
#include <asm/uaccess.h>
#include "aurora.h"
#include "cd180.h"
unsigned char irqs[4] = {
0, 0, 0, 0
};
#ifdef AURORA_INT_DEBUG
int irqhit=0;
#endif
static struct tty_driver *aurora_driver;
static struct Aurora_board aurora_board[AURORA_NBOARD] = {
{0,},
};
static struct Aurora_port aurora_port[AURORA_TNPORTS] = {
{ 0, },
};
/* no longer used. static struct Aurora_board * IRQ_to_board[16] = { NULL, } ;*/
static unsigned char * tmp_buf = NULL;
DECLARE_TASK_QUEUE(tq_aurora);
static inline int aurora_paranoia_check(struct Aurora_port const * port,
char *name, const char *routine)
{
#ifdef AURORA_PARANOIA_CHECK
static const char *badmagic =
KERN_DEBUG "aurora: Warning: bad aurora port magic number for device %s in %s\n";
static const char *badinfo =
KERN_DEBUG "aurora: Warning: null aurora port for device %s in %s\n";
if (!port) {
printk(badinfo, name, routine);
return 1;
}
if (port->magic != AURORA_MAGIC) {
printk(badmagic, name, routine);
return 1;
}
#endif
return 0;
}
/*
*
* Service functions for aurora driver.
*
*/
/* Get board number from pointer */
static inline int board_No (struct Aurora_board const * bp)
{
return bp - aurora_board;
}
/* Get port number from pointer */
static inline int port_No (struct Aurora_port const * port)
{
return AURORA_PORT(port - aurora_port);
}
/* Get pointer to board from pointer to port */
static inline struct Aurora_board * port_Board(struct Aurora_port const * port)
{
return &aurora_board[AURORA_BOARD(port - aurora_port)];
}
/* Wait for Channel Command Register ready */
static inline void aurora_wait_CCR(struct aurora_reg128 * r)
{
unsigned long delay;
#ifdef AURORA_DEBUG
printk("aurora_wait_CCR\n");
#endif
/* FIXME: need something more descriptive than 100000 :) */
for (delay = 100000; delay; delay--)
if (!sbus_readb(&r->r[CD180_CCR]))
return;
printk(KERN_DEBUG "aurora: Timeout waiting for CCR.\n");
}
/*
* aurora probe functions.
*/
/* Must be called with enabled interrupts */
static inline void aurora_long_delay(unsigned long delay)
{
unsigned long i;
#ifdef AURORA_DEBUG
printk("aurora_long_delay: start\n");
#endif
for (i = jiffies + delay; time_before(jiffies, i); ) ;
#ifdef AURORA_DEBUG
printk("aurora_long_delay: end\n");
#endif
}
/* Reset and setup CD180 chip */
static int aurora_init_CD180(struct Aurora_board * bp, int chip)
{
unsigned long flags;
int id;
#ifdef AURORA_DEBUG
printk("aurora_init_CD180: start %d:%d\n",
board_No(bp), chip);
#endif
save_flags(flags); cli();
sbus_writeb(0, &bp->r[chip]->r[CD180_CAR]);
sbus_writeb(0, &bp->r[chip]->r[CD180_GSVR]);
/* Wait for CCR ready */
aurora_wait_CCR(bp->r[chip]);
/* Reset CD180 chip */
sbus_writeb(CCR_HARDRESET, &bp->r[chip]->r[CD180_CCR]);
udelay(1);
sti();
id=1000;
while((--id) &&
(sbus_readb(&bp->r[chip]->r[CD180_GSVR])!=0xff))udelay(100);
if(!id) {
printk(KERN_ERR "aurora%d: Chip %d failed init.\n",
board_No(bp), chip);
restore_flags(flags);
return(-1);
}
cli();
sbus_writeb((board_No(bp)<<5)|((chip+1)<<3),
&bp->r[chip]->r[CD180_GSVR]); /* Set ID for this chip */
sbus_writeb(0x80|bp->ACK_MINT,
&bp->r[chip]->r[CD180_MSMR]); /* Prio for modem intr */
sbus_writeb(0x80|bp->ACK_TINT,
&bp->r[chip]->r[CD180_TSMR]); /* Prio for transmitter intr */
sbus_writeb(0x80|bp->ACK_RINT,
&bp->r[chip]->r[CD180_RSMR]); /* Prio for receiver intr */
/* Setting up prescaler. We need 4 tick per 1 ms */
sbus_writeb((bp->oscfreq/(1000000/AURORA_TPS)) >> 8,
&bp->r[chip]->r[CD180_PPRH]);
sbus_writeb((bp->oscfreq/(1000000/AURORA_TPS)) & 0xff,
&bp->r[chip]->r[CD180_PPRL]);
sbus_writeb(SRCR_AUTOPRI|SRCR_GLOBPRI,
&bp->r[chip]->r[CD180_SRCR]);
id = sbus_readb(&bp->r[chip]->r[CD180_GFRCR]);
printk(KERN_INFO "aurora%d: Chip %d id %02x: ",
board_No(bp), chip,id);
if(sbus_readb(&bp->r[chip]->r[CD180_SRCR]) & 128) {
switch (id) {
case 0x82:printk("CL-CD1864 rev A\n");break;
case 0x83:printk("CL-CD1865 rev A\n");break;
case 0x84:printk("CL-CD1865 rev B\n");break;
case 0x85:printk("CL-CD1865 rev C\n");break;
default:printk("Unknown.\n");
};
} else {
switch (id) {
case 0x81:printk("CL-CD180 rev B\n");break;
case 0x82:printk("CL-CD180 rev C\n");break;
default:printk("Unknown.\n");
};
}
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_init_CD180: end\n");
#endif
return 0;
}
static int valid_irq(unsigned char irq)
{
int i;
for(i=0;i<TYPE_1_IRQS;i++)
if (type_1_irq[i]==irq) return 1;
return 0;
}
static irqreturn_t aurora_interrupt(int irq, void * dev_id);
/* Main probing routine, also sets irq. */
static int aurora_probe(void)
{
struct sbus_bus *sbus;
struct sbus_dev *sdev;
int grrr;
char buf[30];
int bn = 0;
struct Aurora_board *bp;
for_each_sbus(sbus) {
for_each_sbusdev(sdev, sbus) {
/* printk("Try: %x %s\n",sdev,sdev->prom_name);*/
if (!strcmp(sdev->prom_name, "sio16")) {
#ifdef AURORA_DEBUG
printk(KERN_INFO "aurora: sio16 at %p\n",sdev);
#endif
if((sdev->reg_addrs[0].reg_size!=1) &&
(sdev->reg_addrs[1].reg_size!=128) &&
(sdev->reg_addrs[2].reg_size!=128) &&
(sdev->reg_addrs[3].reg_size!=4)) {
printk(KERN_ERR "aurora%d: registers' sizes "
"do not match.\n", bn);
break;
}
bp = &aurora_board[bn];
bp->r0 = (struct aurora_reg1 *)
sbus_ioremap(&sdev->resource[0], 0,
sdev->reg_addrs[0].reg_size,
"sio16");
if (bp->r0 == NULL) {
printk(KERN_ERR "aurora%d: can't map "
"reg_addrs[0]\n", bn);
break;
}
#ifdef AURORA_DEBUG
printk("Map reg 0: %p\n", bp->r0);
#endif
bp->r[0] = (struct aurora_reg128 *)
sbus_ioremap(&sdev->resource[1], 0,
sdev->reg_addrs[1].reg_size,
"sio16");
if (bp->r[0] == NULL) {
printk(KERN_ERR "aurora%d: can't map "
"reg_addrs[1]\n", bn);
break;
}
#ifdef AURORA_DEBUG
printk("Map reg 1: %p\n", bp->r[0]);
#endif
bp->r[1] = (struct aurora_reg128 *)
sbus_ioremap(&sdev->resource[2], 0,
sdev->reg_addrs[2].reg_size,
"sio16");
if (bp->r[1] == NULL) {
printk(KERN_ERR "aurora%d: can't map "
"reg_addrs[2]\n", bn);
break;
}
#ifdef AURORA_DEBUG
printk("Map reg 2: %p\n", bp->r[1]);
#endif
bp->r3 = (struct aurora_reg4 *)
sbus_ioremap(&sdev->resource[3], 0,
sdev->reg_addrs[3].reg_size,
"sio16");
if (bp->r3 == NULL) {
printk(KERN_ERR "aurora%d: can't map "
"reg_addrs[3]\n", bn);
break;
}
#ifdef AURORA_DEBUG
printk("Map reg 3: %p\n", bp->r3);
#endif
/* Variables setup */
bp->flags = 0;
#ifdef AURORA_DEBUG
grrr=prom_getint(sdev->prom_node,"intr");
printk("intr pri %d\n", grrr);
#endif
if ((bp->irq=irqs[bn]) && valid_irq(bp->irq) &&
!request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) {
free_irq(bp->irq|0x30, bp);
} else
if ((bp->irq=prom_getint(sdev->prom_node, "bintr")) && valid_irq(bp->irq) &&
!request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) {
free_irq(bp->irq|0x30, bp);
} else
if ((bp->irq=prom_getint(sdev->prom_node, "intr")) && valid_irq(bp->irq) &&
!request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) {
free_irq(bp->irq|0x30, bp);
} else
for(grrr=0;grrr<TYPE_1_IRQS;grrr++) {
if ((bp->irq=type_1_irq[grrr])&&!request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED, "sio16", bp)) {
free_irq(bp->irq|0x30, bp);
break;
} else {
printk(KERN_ERR "aurora%d: Could not get an irq for this board !!!\n",bn);
bp->flags=0xff;
}
}
if(bp->flags==0xff)break;
printk(KERN_INFO "aurora%d: irq %d\n",bn,bp->irq&0x0f);
buf[0]=0;
grrr=prom_getproperty(sdev->prom_node,"dtr_rts",buf,sizeof(buf));
if(!strcmp(buf,"swapped")){
printk(KERN_INFO "aurora%d: Swapped DTR and RTS\n",bn);
bp->DTR=MSVR_RTS;
bp->RTS=MSVR_DTR;
bp->MSVDTR=CD180_MSVRTS;
bp->MSVRTS=CD180_MSVDTR;
bp->flags|=AURORA_BOARD_DTR_FLOW_OK;
}else{
#ifdef AURORA_FORCE_DTR_FLOW
printk(KERN_INFO "aurora%d: Forcing swapped DTR-RTS\n",bn);
bp->DTR=MSVR_RTS;
bp->RTS=MSVR_DTR;
bp->MSVDTR=CD180_MSVRTS;
bp->MSVRTS=CD180_MSVDTR;
bp->flags|=AURORA_BOARD_DTR_FLOW_OK;
#else
printk(KERN_INFO "aurora%d: Normal DTR and RTS\n",bn);
bp->DTR=MSVR_DTR;
bp->RTS=MSVR_RTS;
bp->MSVDTR=CD180_MSVDTR;
bp->MSVRTS=CD180_MSVRTS;
#endif
}
bp->oscfreq=prom_getint(sdev->prom_node,"clk")*100;
printk(KERN_INFO "aurora%d: Oscillator: %d Hz\n",bn,bp->oscfreq);
grrr=prom_getproperty(sdev->prom_node,"chip",buf,sizeof(buf));
printk(KERN_INFO "aurora%d: Chips: %s\n",bn,buf);
grrr=prom_getproperty(sdev->prom_node,"manu",buf,sizeof(buf));
printk(KERN_INFO "aurora%d: Manufacturer: %s\n",bn,buf);
grrr=prom_getproperty(sdev->prom_node,"model",buf,sizeof(buf));
printk(KERN_INFO "aurora%d: Model: %s\n",bn,buf);
grrr=prom_getproperty(sdev->prom_node,"rev",buf,sizeof(buf));
printk(KERN_INFO "aurora%d: Revision: %s\n",bn,buf);
grrr=prom_getproperty(sdev->prom_node,"mode",buf,sizeof(buf));
printk(KERN_INFO "aurora%d: Mode: %s\n",bn,buf);
#ifdef MODULE
bp->count=0;
#endif
bp->flags = AURORA_BOARD_PRESENT;
/* hardware ack */
bp->ACK_MINT=1;
bp->ACK_TINT=2;
bp->ACK_RINT=3;
bn++;
}
}
}
return bn;
}
static void aurora_release_io_range(struct Aurora_board *bp)
{
sbus_iounmap((unsigned long)bp->r0, 1);
sbus_iounmap((unsigned long)bp->r[0], 128);
sbus_iounmap((unsigned long)bp->r[1], 128);
sbus_iounmap((unsigned long)bp->r3, 4);
}
static inline void aurora_mark_event(struct Aurora_port * port, int event)
{
#ifdef AURORA_DEBUG
printk("aurora_mark_event: start\n");
#endif
set_bit(event, &port->event);
queue_task(&port->tqueue, &tq_aurora);
mark_bh(AURORA_BH);
#ifdef AURORA_DEBUG
printk("aurora_mark_event: end\n");
#endif
}
static __inline__ struct Aurora_port * aurora_get_port(struct Aurora_board const * bp,
int chip,
unsigned char const *what)
{
unsigned char channel;
struct Aurora_port * port;
channel = ((chip << 3) |
((sbus_readb(&bp->r[chip]->r[CD180_GSCR]) & GSCR_CHAN) >> GSCR_CHAN_OFF));
port = &aurora_port[board_No(bp) * AURORA_NPORT * AURORA_NCD180 + channel];
if (port->flags & ASYNC_INITIALIZED)
return port;
printk(KERN_DEBUG "aurora%d: %s interrupt from invalid port %d\n",
board_No(bp), what, channel);
return NULL;
}
static void aurora_receive_exc(struct Aurora_board const * bp, int chip)
{
struct Aurora_port *port;
struct tty_struct *tty;
unsigned char status;
unsigned char ch;
if (!(port = aurora_get_port(bp, chip, "Receive_x")))
return;
tty = port->tty;
if (tty->flip.count >= TTY_FLIPBUF_SIZE) {
#ifdef AURORA_INTNORM
printk("aurora%d: port %d: Working around flip buffer overflow.\n",
board_No(bp), port_No(port));
#endif
return;
}
#ifdef AURORA_REPORT_OVERRUN
status = sbus_readb(&bp->r[chip]->r[CD180_RCSR]);
if (status & RCSR_OE) {
port->overrun++;
#if 1
printk("aurora%d: port %d: Overrun. Total %ld overruns.\n",
board_No(bp), port_No(port), port->overrun);
#endif
}
status &= port->mark_mask;
#else
status = sbus_readb(&bp->r[chip]->r[CD180_RCSR]) & port->mark_mask;
#endif
ch = sbus_readb(&bp->r[chip]->r[CD180_RDR]);
if (!status)
return;
if (status & RCSR_TOUT) {
/* printk("aurora%d: port %d: Receiver timeout. Hardware problems ?\n",
board_No(bp), port_No(port));*/
return;
} else if (status & RCSR_BREAK) {
printk(KERN_DEBUG "aurora%d: port %d: Handling break...\n",
board_No(bp), port_No(port));
*tty->flip.flag_buf_ptr++ = TTY_BREAK;
if (port->flags & ASYNC_SAK)
do_SAK(tty);
} else if (status & RCSR_PE)
*tty->flip.flag_buf_ptr++ = TTY_PARITY;
else if (status & RCSR_FE)
*tty->flip.flag_buf_ptr++ = TTY_FRAME;
else if (status & RCSR_OE)
*tty->flip.flag_buf_ptr++ = TTY_OVERRUN;
else
*tty->flip.flag_buf_ptr++ = 0;
*tty->flip.char_buf_ptr++ = ch;
tty->flip.count++;
queue_task(&tty->flip.tqueue, &tq_timer);
}
static void aurora_receive(struct Aurora_board const * bp, int chip)
{
struct Aurora_port *port;
struct tty_struct *tty;
unsigned char count,cnt;
if (!(port = aurora_get_port(bp, chip, "Receive")))
return;
tty = port->tty;
count = sbus_readb(&bp->r[chip]->r[CD180_RDCR]);
#ifdef AURORA_REPORT_FIFO
port->hits[count > 8 ? 9 : count]++;
#endif
while (count--) {
if (tty->flip.count >= TTY_FLIPBUF_SIZE) {
#ifdef AURORA_INTNORM
printk("aurora%d: port %d: Working around flip buffer overflow.\n",
board_No(bp), port_No(port));
#endif
break;
}
cnt = sbus_readb(&bp->r[chip]->r[CD180_RDR]);
*tty->flip.char_buf_ptr++ = cnt;
*tty->flip.flag_buf_ptr++ = 0;
tty->flip.count++;
}
queue_task(&tty->flip.tqueue, &tq_timer);
}
static void aurora_transmit(struct Aurora_board const * bp, int chip)
{
struct Aurora_port *port;
struct tty_struct *tty;
unsigned char count;
if (!(port = aurora_get_port(bp, chip, "Transmit")))
return;
tty = port->tty;
if (port->SRER & SRER_TXEMPTY) {
/* FIFO drained */
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
port->SRER &= ~SRER_TXEMPTY;
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
return;
}
if ((port->xmit_cnt <= 0 && !port->break_length)
|| tty->stopped || tty->hw_stopped) {
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
port->SRER &= ~SRER_TXRDY;
sbus_writeb(port->SRER,
&bp->r[chip]->r[CD180_SRER]);
return;
}
if (port->break_length) {
if (port->break_length > 0) {
if (port->COR2 & COR2_ETC) {
sbus_writeb(CD180_C_ESC,
&bp->r[chip]->r[CD180_TDR]);
sbus_writeb(CD180_C_SBRK,
&bp->r[chip]->r[CD180_TDR]);
port->COR2 &= ~COR2_ETC;
}
count = min(port->break_length, 0xff);
sbus_writeb(CD180_C_ESC,
&bp->r[chip]->r[CD180_TDR]);
sbus_writeb(CD180_C_DELAY,
&bp->r[chip]->r[CD180_TDR]);
sbus_writeb(count,
&bp->r[chip]->r[CD180_TDR]);
if (!(port->break_length -= count))
port->break_length--;
} else {
sbus_writeb(CD180_C_ESC,
&bp->r[chip]->r[CD180_TDR]);
sbus_writeb(CD180_C_EBRK,
&bp->r[chip]->r[CD180_TDR]);
sbus_writeb(port->COR2,
&bp->r[chip]->r[CD180_COR2]);
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_CORCHG2,
&bp->r[chip]->r[CD180_CCR]);
port->break_length = 0;
}
return;
}
count = CD180_NFIFO;
do {
u8 byte = port->xmit_buf[port->xmit_tail++];
sbus_writeb(byte, &bp->r[chip]->r[CD180_TDR]);
port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE-1);
if (--port->xmit_cnt <= 0)
break;
} while (--count > 0);
if (port->xmit_cnt <= 0) {
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
port->SRER &= ~SRER_TXRDY;
sbus_writeb(port->SRER,
&bp->r[chip]->r[CD180_SRER]);
}
if (port->xmit_cnt <= port->wakeup_chars)
aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP);
}
static void aurora_check_modem(struct Aurora_board const * bp, int chip)
{
struct Aurora_port *port;
struct tty_struct *tty;
unsigned char mcr;
if (!(port = aurora_get_port(bp, chip, "Modem")))
return;
tty = port->tty;
mcr = sbus_readb(&bp->r[chip]->r[CD180_MCR]);
if (mcr & MCR_CDCHG) {
if (sbus_readb(&bp->r[chip]->r[CD180_MSVR]) & MSVR_CD)
wake_up_interruptible(&port->open_wait);
else
schedule_task(&port->tqueue_hangup);
}
/* We don't have such things yet. My aurora board has DTR and RTS swapped, but that doesn't count in this driver. Let's hope
* Aurora didn't made any boards with CTS or DSR broken...
*/
/* #ifdef AURORA_BRAIN_DAMAGED_CTS
if (mcr & MCR_CTSCHG) {
if (aurora_in(bp, CD180_MSVR) & MSVR_CTS) {
tty->hw_stopped = 0;
port->SRER |= SRER_TXRDY;
if (port->xmit_cnt <= port->wakeup_chars)
aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP);
} else {
tty->hw_stopped = 1;
port->SRER &= ~SRER_TXRDY;
}
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
}
if (mcr & MCR_DSRCHG) {
if (aurora_in(bp, CD180_MSVR) & MSVR_DSR) {
tty->hw_stopped = 0;
port->SRER |= SRER_TXRDY;
if (port->xmit_cnt <= port->wakeup_chars)
aurora_mark_event(port, RS_EVENT_WRITE_WAKEUP);
} else {
tty->hw_stopped = 1;
port->SRER &= ~SRER_TXRDY;
}
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
}
#endif AURORA_BRAIN_DAMAGED_CTS */
/* Clear change bits */
sbus_writeb(0, &bp->r[chip]->r[CD180_MCR]);
}
/* The main interrupt processing routine */
static irqreturn_t aurora_interrupt(int irq, void * dev_id)
{
unsigned char status;
unsigned char ack,chip/*,chip_id*/;
struct Aurora_board * bp = (struct Aurora_board *) dev_id;
unsigned long loop = 0;
#ifdef AURORA_INT_DEBUG
printk("IRQ%d %d\n",irq,++irqhit);
#ifdef AURORA_FLOODPRO
if (irqhit>=AURORA_FLOODPRO)
sbus_writeb(8, &bp->r0->r);
#endif
#endif
/* old bp = IRQ_to_board[irq&0x0f];*/
if (!bp || !(bp->flags & AURORA_BOARD_ACTIVE))
return IRQ_NONE;
/* The while() below takes care of this.
status = sbus_readb(&bp->r[0]->r[CD180_SRSR]);
#ifdef AURORA_INT_DEBUG
printk("mumu: %02x\n", status);
#endif
if (!(status&SRSR_ANYINT))
return IRQ_NONE; * Nobody has anything to say, so exit *
*/
while ((loop++ < 48) &&
(status = sbus_readb(&bp->r[0]->r[CD180_SRSR]) & SRSR_ANYINT)){
#ifdef AURORA_INT_DEBUG
printk("SRSR: %02x\n", status);
#endif
if (status & SRSR_REXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_RINT]);
#ifdef AURORA_INT_DEBUG
printk("R-ACK %02x\n", ack);
#endif
if ((ack >> 5) == board_No(bp)) {
if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) {
if ((ack&GSVR_ITMASK)==GSVR_IT_RGD) {
aurora_receive(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
} else if ((ack & GSVR_ITMASK) == GSVR_IT_REXC) {
aurora_receive_exc(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
}
}
}
} else if (status & SRSR_TEXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_TINT]);
#ifdef AURORA_INT_DEBUG
printk("T-ACK %02x\n", ack);
#endif
if ((ack >> 5) == board_No(bp)) {
if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) {
if ((ack&GSVR_ITMASK)==GSVR_IT_TX) {
aurora_transmit(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
}
}
}
} else if (status & SRSR_MEXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_MINT]);
#ifdef AURORA_INT_DEBUG
printk("M-ACK %02x\n", ack);
#endif
if ((ack >> 5) == board_No(bp)) {
if ((chip = ((ack>>3)&3)-1) < AURORA_NCD180) {
if ((ack&GSVR_ITMASK)==GSVR_IT_MDM) {
aurora_check_modem(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
}
}
}
}
}
/* I guess this faster code can be used with CD1865, using AUROPRI and GLOBPRI. */
#if 0
while ((loop++ < 48)&&(status=bp->r[0]->r[CD180_SRSR]&SRSR_ANYINT)){
#ifdef AURORA_INT_DEBUG
printk("SRSR: %02x\n",status);
#endif
ack = sbus_readb(&bp->r3->r[0]);
#ifdef AURORA_INT_DEBUG
printk("ACK: %02x\n",ack);
#endif
if ((ack>>5)==board_No(bp)) {
if ((chip=((ack>>3)&3)-1) < AURORA_NCD180) {
ack&=GSVR_ITMASK;
if (ack==GSVR_IT_RGD) {
aurora_receive(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
} else if (ack==GSVR_IT_REXC) {
aurora_receive_exc(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
} else if (ack==GSVR_IT_TX) {
aurora_transmit(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
} else if (ack==GSVR_IT_MDM) {
aurora_check_modem(bp,chip);
sbus_writeb(0,
&bp->r[chip]->r[CD180_EOSRR]);
}
}
}
}
#endif
/* This is the old handling routine, used in riscom8 for only one CD180. I keep it here for reference. */
#if 0
for(chip=0;chip<AURORA_NCD180;chip++){
chip_id=(board_No(bp)<<5)|((chip+1)<<3);
loop=0;
while ((loop++ < 1) &&
((status = sbus_readb(&bp->r[chip]->r[CD180_SRSR])) &
(SRSR_TEXT | SRSR_MEXT | SRSR_REXT))) {
if (status & SRSR_REXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_RINT]);
if (ack == (chip_id | GSVR_IT_RGD)) {
#ifdef AURORA_INTMSG
printk("RX ACK\n");
#endif
aurora_receive(bp,chip);
} else if (ack == (chip_id | GSVR_IT_REXC)) {
#ifdef AURORA_INTMSG
printk("RXC ACK\n");
#endif
aurora_receive_exc(bp,chip);
} else {
#ifdef AURORA_INTNORM
printk("aurora%d-%d: Bad receive ack 0x%02x.\n",
board_No(bp), chip, ack);
#endif
}
} else if (status & SRSR_TEXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_TINT]);
if (ack == (chip_id | GSVR_IT_TX)){
#ifdef AURORA_INTMSG
printk("TX ACK\n");
#endif
aurora_transmit(bp,chip);
} else {
#ifdef AURORA_INTNORM
printk("aurora%d-%d: Bad transmit ack 0x%02x.\n",
board_No(bp), chip, ack);
#endif
}
} else if (status & SRSR_MEXT) {
ack = sbus_readb(&bp->r3->r[bp->ACK_MINT]);
if (ack == (chip_id | GSVR_IT_MDM)){
#ifdef AURORA_INTMSG
printk("MDM ACK\n");
#endif
aurora_check_modem(bp,chip);
} else {
#ifdef AURORA_INTNORM
printk("aurora%d-%d: Bad modem ack 0x%02x.\n",
board_No(bp), chip, ack);
#endif
}
}
sbus_writeb(0, &bp->r[chip]->r[CD180_EOSRR]);
}
}
#endif
return IRQ_HANDLED;
}
#ifdef AURORA_INT_DEBUG
static void aurora_timer (unsigned long ignored);
static DEFINE_TIMER(aurora_poll_timer, aurora_timer, 0, 0);
static void
aurora_timer (unsigned long ignored)
{
unsigned long flags;
int i;
save_flags(flags); cli();
printk("SRSR: %02x,%02x - ",
sbus_readb(&aurora_board[0].r[0]->r[CD180_SRSR]),
sbus_readb(&aurora_board[0].r[1]->r[CD180_SRSR]));
for (i = 0; i < 4; i++) {
udelay(1);
printk("%02x ",
sbus_readb(&aurora_board[0].r3->r[i]));
}
printk("\n");
aurora_poll_timer.expires = jiffies + 300;
add_timer (&aurora_poll_timer);
restore_flags(flags);
}
#endif
/*
* Routines for open & close processing.
*/
/* Called with disabled interrupts */
static int aurora_setup_board(struct Aurora_board * bp)
{
int error;
#ifdef AURORA_ALLIRQ
int i;
for (i = 0; i < AURORA_ALLIRQ; i++) {
error = request_irq(allirq[i]|0x30, aurora_interrupt, IRQF_SHARED,
"sio16", bp);
if (error)
printk(KERN_ERR "IRQ%d request error %d\n",
allirq[i], error);
}
#else
error = request_irq(bp->irq|0x30, aurora_interrupt, IRQF_SHARED,
"sio16", bp);
if (error) {
printk(KERN_ERR "IRQ request error %d\n", error);
return error;
}
#endif
/* Board reset */
sbus_writeb(0, &bp->r0->r);
udelay(1);
if (bp->flags & AURORA_BOARD_TYPE_2) {
/* unknown yet */
} else {
sbus_writeb((AURORA_CFG_ENABLE_IO | AURORA_CFG_ENABLE_IRQ |
(((bp->irq)&0x0f)>>2)),
&bp->r0->r);
}
udelay(10000);
if (aurora_init_CD180(bp,0))error=1;error=0;
if (aurora_init_CD180(bp,1))error++;
if (error == AURORA_NCD180) {
printk(KERN_ERR "Both chips failed initialisation.\n");
return -EIO;
}
#ifdef AURORA_INT_DEBUG
aurora_poll_timer.expires= jiffies + 1;
add_timer(&aurora_poll_timer);
#endif
#ifdef AURORA_DEBUG
printk("aurora_setup_board: end\n");
#endif
return 0;
}
/* Called with disabled interrupts */
static void aurora_shutdown_board(struct Aurora_board *bp)
{
int i;
#ifdef AURORA_DEBUG
printk("aurora_shutdown_board: start\n");
#endif
#ifdef AURORA_INT_DEBUG
del_timer(&aurora_poll_timer);
#endif
#ifdef AURORA_ALLIRQ
for(i=0;i<AURORA_ALLIRQ;i++){
free_irq(allirq[i]|0x30, bp);
/* IRQ_to_board[allirq[i]&0xf] = NULL;*/
}
#else
free_irq(bp->irq|0x30, bp);
/* IRQ_to_board[bp->irq&0xf] = NULL;*/
#endif
/* Drop all DTR's */
for(i=0;i<16;i++){
sbus_writeb(i & 7, &bp->r[i>>3]->r[CD180_CAR]);
udelay(1);
sbus_writeb(0, &bp->r[i>>3]->r[CD180_MSVR]);
udelay(1);
}
/* Board shutdown */
sbus_writeb(0, &bp->r0->r);
#ifdef AURORA_DEBUG
printk("aurora_shutdown_board: end\n");
#endif
}
/* Setting up port characteristics.
* Must be called with disabled interrupts
*/
static void aurora_change_speed(struct Aurora_board *bp, struct Aurora_port *port)
{
struct tty_struct *tty;
unsigned long baud;
long tmp;
unsigned char cor1 = 0, cor3 = 0;
unsigned char mcor1 = 0, mcor2 = 0,chip;
#ifdef AURORA_DEBUG
printk("aurora_change_speed: start\n");
#endif
if (!(tty = port->tty) || !tty->termios)
return;
chip = AURORA_CD180(port_No(port));
port->SRER = 0;
port->COR2 = 0;
port->MSVR = MSVR_RTS|MSVR_DTR;
baud = tty_get_baud_rate(tty);
/* Select port on the board */
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
if (!baud) {
/* Drop DTR & exit */
port->MSVR &= ~(bp->DTR|bp->RTS);
sbus_writeb(port->MSVR,
&bp->r[chip]->r[CD180_MSVR]);
return;
} else {
/* Set DTR on */
port->MSVR |= bp->DTR;
sbus_writeb(port->MSVR,
&bp->r[chip]->r[CD180_MSVR]);
}
/* Now we must calculate some speed dependent things. */
/* Set baud rate for port. */
tmp = (((bp->oscfreq + baud/2) / baud +
CD180_TPC/2) / CD180_TPC);
/* tmp = (bp->oscfreq/7)/baud;
if((tmp%10)>4)tmp=tmp/10+1;else tmp=tmp/10;*/
/* printk("Prescaler period: %d\n",tmp);*/
sbus_writeb((tmp >> 8) & 0xff,
&bp->r[chip]->r[CD180_RBPRH]);
sbus_writeb((tmp >> 8) & 0xff,
&bp->r[chip]->r[CD180_TBPRH]);
sbus_writeb(tmp & 0xff, &bp->r[chip]->r[CD180_RBPRL]);
sbus_writeb(tmp & 0xff, &bp->r[chip]->r[CD180_TBPRL]);
baud = (baud + 5) / 10; /* Estimated CPS */
/* Two timer ticks seems enough to wakeup something like SLIP driver */
tmp = ((baud + HZ/2) / HZ) * 2 - CD180_NFIFO;
port->wakeup_chars = (tmp < 0) ? 0 : ((tmp >= SERIAL_XMIT_SIZE) ?
SERIAL_XMIT_SIZE - 1 : tmp);
/* Receiver timeout will be transmission time for 1.5 chars */
tmp = (AURORA_TPS + AURORA_TPS/2 + baud/2) / baud;
tmp = (tmp > 0xff) ? 0xff : tmp;
sbus_writeb(tmp, &bp->r[chip]->r[CD180_RTPR]);
switch (C_CSIZE(tty)) {
case CS5:
cor1 |= COR1_5BITS;
break;
case CS6:
cor1 |= COR1_6BITS;
break;
case CS7:
cor1 |= COR1_7BITS;
break;
case CS8:
cor1 |= COR1_8BITS;
break;
}
if (C_CSTOPB(tty))
cor1 |= COR1_2SB;
cor1 |= COR1_IGNORE;
if (C_PARENB(tty)) {
cor1 |= COR1_NORMPAR;
if (C_PARODD(tty))
cor1 |= COR1_ODDP;
if (I_INPCK(tty))
cor1 &= ~COR1_IGNORE;
}
/* Set marking of some errors */
port->mark_mask = RCSR_OE | RCSR_TOUT;
if (I_INPCK(tty))
port->mark_mask |= RCSR_FE | RCSR_PE;
if (I_BRKINT(tty) || I_PARMRK(tty))
port->mark_mask |= RCSR_BREAK;
if (I_IGNPAR(tty))
port->mark_mask &= ~(RCSR_FE | RCSR_PE);
if (I_IGNBRK(tty)) {
port->mark_mask &= ~RCSR_BREAK;
if (I_IGNPAR(tty))
/* Real raw mode. Ignore all */
port->mark_mask &= ~RCSR_OE;
}
/* Enable Hardware Flow Control */
if (C_CRTSCTS(tty)) {
/*#ifdef AURORA_BRAIN_DAMAGED_CTS
port->SRER |= SRER_DSR | SRER_CTS;
mcor1 |= MCOR1_DSRZD | MCOR1_CTSZD;
mcor2 |= MCOR2_DSROD | MCOR2_CTSOD;
tty->hw_stopped = !(aurora_in(bp, CD180_MSVR) & (MSVR_CTS|MSVR_DSR));
#else*/
port->COR2 |= COR2_CTSAE;
/*#endif*/
if (bp->flags&AURORA_BOARD_DTR_FLOW_OK) {
mcor1 |= AURORA_RXTH;
}
}
/* Enable Software Flow Control. FIXME: I'm not sure about this */
/* Some people reported that it works, but I still doubt */
if (I_IXON(tty)) {
port->COR2 |= COR2_TXIBE;
cor3 |= (COR3_FCT | COR3_SCDE);
if (I_IXANY(tty))
port->COR2 |= COR2_IXM;
sbus_writeb(START_CHAR(tty),
&bp->r[chip]->r[CD180_SCHR1]);
sbus_writeb(STOP_CHAR(tty),
&bp->r[chip]->r[CD180_SCHR2]);
sbus_writeb(START_CHAR(tty),
&bp->r[chip]->r[CD180_SCHR3]);
sbus_writeb(STOP_CHAR(tty),
&bp->r[chip]->r[CD180_SCHR4]);
}
if (!C_CLOCAL(tty)) {
/* Enable CD check */
port->SRER |= SRER_CD;
mcor1 |= MCOR1_CDZD;
mcor2 |= MCOR2_CDOD;
}
if (C_CREAD(tty))
/* Enable receiver */
port->SRER |= SRER_RXD;
/* Set input FIFO size (1-8 bytes) */
cor3 |= AURORA_RXFIFO;
/* Setting up CD180 channel registers */
sbus_writeb(cor1, &bp->r[chip]->r[CD180_COR1]);
sbus_writeb(port->COR2, &bp->r[chip]->r[CD180_COR2]);
sbus_writeb(cor3, &bp->r[chip]->r[CD180_COR3]);
/* Make CD180 know about registers change */
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_CORCHG1 | CCR_CORCHG2 | CCR_CORCHG3,
&bp->r[chip]->r[CD180_CCR]);
/* Setting up modem option registers */
sbus_writeb(mcor1, &bp->r[chip]->r[CD180_MCOR1]);
sbus_writeb(mcor2, &bp->r[chip]->r[CD180_MCOR2]);
/* Enable CD180 transmitter & receiver */
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_TXEN | CCR_RXEN, &bp->r[chip]->r[CD180_CCR]);
/* Enable interrupts */
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
/* And finally set RTS on */
sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]);
#ifdef AURORA_DEBUG
printk("aurora_change_speed: end\n");
#endif
}
/* Must be called with interrupts enabled */
static int aurora_setup_port(struct Aurora_board *bp, struct Aurora_port *port)
{
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_setup_port: start %d\n",port_No(port));
#endif
if (port->flags & ASYNC_INITIALIZED)
return 0;
if (!port->xmit_buf) {
/* We may sleep in get_zeroed_page() */
unsigned long tmp;
if (!(tmp = get_zeroed_page(GFP_KERNEL)))
return -ENOMEM;
if (port->xmit_buf) {
free_page(tmp);
return -ERESTARTSYS;
}
port->xmit_buf = (unsigned char *) tmp;
}
save_flags(flags); cli();
if (port->tty)
clear_bit(TTY_IO_ERROR, &port->tty->flags);
#ifdef MODULE
if ((port->count == 1) && ((++bp->count) == 1))
bp->flags |= AURORA_BOARD_ACTIVE;
#endif
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
aurora_change_speed(bp, port);
port->flags |= ASYNC_INITIALIZED;
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_setup_port: end\n");
#endif
return 0;
}
/* Must be called with interrupts disabled */
static void aurora_shutdown_port(struct Aurora_board *bp, struct Aurora_port *port)
{
struct tty_struct *tty;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_shutdown_port: start\n");
#endif
if (!(port->flags & ASYNC_INITIALIZED))
return;
chip = AURORA_CD180(port_No(port));
#ifdef AURORA_REPORT_OVERRUN
printk("aurora%d: port %d: Total %ld overruns were detected.\n",
board_No(bp), port_No(port), port->overrun);
#endif
#ifdef AURORA_REPORT_FIFO
{
int i;
printk("aurora%d: port %d: FIFO hits [ ",
board_No(bp), port_No(port));
for (i = 0; i < 10; i++) {
printk("%ld ", port->hits[i]);
}
printk("].\n");
}
#endif
if (port->xmit_buf) {
free_page((unsigned long) port->xmit_buf);
port->xmit_buf = NULL;
}
if (!(tty = port->tty) || C_HUPCL(tty)) {
/* Drop DTR */
port->MSVR &= ~(bp->DTR|bp->RTS);
sbus_writeb(port->MSVR,
&bp->r[chip]->r[CD180_MSVR]);
}
/* Select port */
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
/* Reset port */
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_SOFTRESET, &bp->r[chip]->r[CD180_CCR]);
/* Disable all interrupts from this port */
port->SRER = 0;
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
if (tty)
set_bit(TTY_IO_ERROR, &tty->flags);
port->flags &= ~ASYNC_INITIALIZED;
#ifdef MODULE
if (--bp->count < 0) {
printk(KERN_DEBUG "aurora%d: aurora_shutdown_port: "
"bad board count: %d\n",
board_No(bp), bp->count);
bp->count = 0;
}
if (!bp->count)
bp->flags &= ~AURORA_BOARD_ACTIVE;
#endif
#ifdef AURORA_DEBUG
printk("aurora_shutdown_port: end\n");
#endif
}
static int block_til_ready(struct tty_struct *tty, struct file * filp,
struct Aurora_port *port)
{
DECLARE_WAITQUEUE(wait, current);
struct Aurora_board *bp = port_Board(port);
int retval;
int do_clocal = 0;
int CD;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("block_til_ready: start\n");
#endif
chip = AURORA_CD180(port_No(port));
/* If the device is in the middle of being closed, then block
* until it's done, and then try again.
*/
if (tty_hung_up_p(filp) || port->flags & ASYNC_CLOSING) {
interruptible_sleep_on(&port->close_wait);
if (port->flags & ASYNC_HUP_NOTIFY)
return -EAGAIN;
else
return -ERESTARTSYS;
}
/* If non-blocking mode is set, or the port is not enabled,
* then make the check up front and then exit.
*/
if ((filp->f_flags & O_NONBLOCK) ||
(tty->flags & (1 << TTY_IO_ERROR))) {
port->flags |= ASYNC_NORMAL_ACTIVE;
return 0;
}
if (C_CLOCAL(tty))
do_clocal = 1;
/* Block waiting for the carrier detect and the line to become
* free (i.e., not in use by the callout). While we are in
* this loop, info->count is dropped by one, so that
* rs_close() knows when to free things. We restore it upon
* exit, either normal or abnormal.
*/
retval = 0;
add_wait_queue(&port->open_wait, &wait);
cli();
if (!tty_hung_up_p(filp))
port->count--;
sti();
port->blocked_open++;
while (1) {
cli();
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
CD = sbus_readb(&bp->r[chip]->r[CD180_MSVR]) & MSVR_CD;
port->MSVR=bp->RTS;
/* auto drops DTR */
sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]);
sti();
set_current_state(TASK_INTERRUPTIBLE);
if (tty_hung_up_p(filp) ||
!(port->flags & ASYNC_INITIALIZED)) {
if (port->flags & ASYNC_HUP_NOTIFY)
retval = -EAGAIN;
else
retval = -ERESTARTSYS;
break;
}
if (!(port->flags & ASYNC_CLOSING) &&
(do_clocal || CD))
break;
if (signal_pending(current)) {
retval = -ERESTARTSYS;
break;
}
schedule();
}
current->state = TASK_RUNNING;
remove_wait_queue(&port->open_wait, &wait);
if (!tty_hung_up_p(filp))
port->count++;
port->blocked_open--;
if (retval)
return retval;
port->flags |= ASYNC_NORMAL_ACTIVE;
#ifdef AURORA_DEBUG
printk("block_til_ready: end\n");
#endif
return 0;
}
static int aurora_open(struct tty_struct * tty, struct file * filp)
{
int board;
int error;
struct Aurora_port * port;
struct Aurora_board * bp;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_open: start\n");
#endif
board = AURORA_BOARD(tty->index);
if (board > AURORA_NBOARD ||
!(aurora_board[board].flags & AURORA_BOARD_PRESENT)) {
#ifdef AURORA_DEBUG
printk("aurora_open: error board %d present %d\n",
board, aurora_board[board].flags & AURORA_BOARD_PRESENT);
#endif
return -ENODEV;
}
bp = &aurora_board[board];
port = aurora_port + board * AURORA_NPORT * AURORA_NCD180 + AURORA_PORT(tty->index);
if ((aurora_paranoia_check(port, tty->name, "aurora_open")) {
#ifdef AURORA_DEBUG
printk("aurora_open: error paranoia check\n");
#endif
return -ENODEV;
}
port->count++;
tty->driver_data = port;
port->tty = tty;
if ((error = aurora_setup_port(bp, port))) {
#ifdef AURORA_DEBUG
printk("aurora_open: error aurora_setup_port ret %d\n",error);
#endif
return error;
}
if ((error = block_til_ready(tty, filp, port))) {
#ifdef AURORA_DEBUG
printk("aurora_open: error block_til_ready ret %d\n",error);
#endif
return error;
}
#ifdef AURORA_DEBUG
printk("aurora_open: end\n");
#endif
return 0;
}
static void aurora_close(struct tty_struct * tty, struct file * filp)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
unsigned long flags;
unsigned long timeout;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_close: start\n");
#endif
if (!port || (aurora_paranoia_check(port, tty->name, "close"))
return;
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
if (tty_hung_up_p(filp)) {
restore_flags(flags);
return;
}
bp = port_Board(port);
if ((tty->count == 1) && (port->count != 1)) {
printk(KERN_DEBUG "aurora%d: aurora_close: bad port count; "
"tty->count is 1, port count is %d\n",
board_No(bp), port->count);
port->count = 1;
}
if (--port->count < 0) {
printk(KERN_DEBUG "aurora%d: aurora_close: bad port "
"count for tty%d: %d\n",
board_No(bp), port_No(port), port->count);
port->count = 0;
}
if (port->count) {
restore_flags(flags);
return;
}
port->flags |= ASYNC_CLOSING;
/* Now we wait for the transmit buffer to clear; and we notify
* the line discipline to only process XON/XOFF characters.
*/
tty->closing = 1;
if (port->closing_wait != ASYNC_CLOSING_WAIT_NONE){
#ifdef AURORA_DEBUG
printk("aurora_close: waiting to flush...\n");
#endif
tty_wait_until_sent(tty, port->closing_wait);
}
/* At this point we stop accepting input. To do this, we
* disable the receive line status interrupts, and tell the
* interrupt driver to stop checking the data ready bit in the
* line status register.
*/
port->SRER &= ~SRER_RXD;
if (port->flags & ASYNC_INITIALIZED) {
port->SRER &= ~SRER_TXRDY;
port->SRER |= SRER_TXEMPTY;
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
/*
* Before we drop DTR, make sure the UART transmitter
* has completely drained; this is especially
* important if there is a transmit FIFO!
*/
timeout = jiffies+HZ;
while(port->SRER & SRER_TXEMPTY) {
msleep_interruptible(jiffies_to_msecs(port->timeout));
if (time_after(jiffies, timeout))
break;
}
}
#ifdef AURORA_DEBUG
printk("aurora_close: shutdown_port\n");
#endif
aurora_shutdown_port(bp, port);
if (tty->driver->flush_buffer)
tty->driver->flush_buffer(tty);
tty_ldisc_flush(tty);
tty->closing = 0;
port->event = 0;
port->tty = 0;
if (port->blocked_open) {
if (port->close_delay) {
msleep_interruptible(jiffies_to_msecs(port->close_delay));
}
wake_up_interruptible(&port->open_wait);
}
port->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
wake_up_interruptible(&port->close_wait);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_close: end\n");
#endif
}
static int aurora_write(struct tty_struct * tty,
const unsigned char *buf, int count)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
int c, total = 0;
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_write: start %d\n",count);
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_write"))
return 0;
chip = AURORA_CD180(port_No(port));
bp = port_Board(port);
if (!tty || !port->xmit_buf || !tmp_buf)
return 0;
save_flags(flags);
while (1) {
cli();
c = min(count, min(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
SERIAL_XMIT_SIZE - port->xmit_head));
if (c <= 0) {
restore_flags(flags);
break;
}
memcpy(port->xmit_buf + port->xmit_head, buf, c);
port->xmit_head = (port->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
port->xmit_cnt += c;
restore_flags(flags);
buf += c;
count -= c;
total += c;
}
cli();
if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped &&
!(port->SRER & SRER_TXRDY)) {
port->SRER |= SRER_TXRDY;
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
}
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_write: end %d\n",total);
#endif
return total;
}
static void aurora_put_char(struct tty_struct * tty, unsigned char ch)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_put_char: start %c\n",ch);
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_put_char"))
return;
if (!tty || !port->xmit_buf)
return;
save_flags(flags); cli();
if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1) {
restore_flags(flags);
return;
}
port->xmit_buf[port->xmit_head++] = ch;
port->xmit_head &= SERIAL_XMIT_SIZE - 1;
port->xmit_cnt++;
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_put_char: end\n");
#endif
}
static void aurora_flush_chars(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
unsigned long flags;
unsigned char chip;
/*#ifdef AURORA_DEBUG
printk("aurora_flush_chars: start\n");
#endif*/
if ((aurora_paranoia_check(port, tty->name, "aurora_flush_chars"))
return;
chip = AURORA_CD180(port_No(port));
if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
!port->xmit_buf)
return;
save_flags(flags); cli();
port->SRER |= SRER_TXRDY;
sbus_writeb(port_No(port) & 7,
&port_Board(port)->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->SRER,
&port_Board(port)->r[chip]->r[CD180_SRER]);
restore_flags(flags);
/*#ifdef AURORA_DEBUG
printk("aurora_flush_chars: end\n");
#endif*/
}
static int aurora_write_room(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
int ret;
#ifdef AURORA_DEBUG
printk("aurora_write_room: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_write_room"))
return 0;
ret = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
if (ret < 0)
ret = 0;
#ifdef AURORA_DEBUG
printk("aurora_write_room: end\n");
#endif
return ret;
}
static int aurora_chars_in_buffer(struct tty_struct *tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
if ((aurora_paranoia_check(port, tty->name, "aurora_chars_in_buffer"))
return 0;
return port->xmit_cnt;
}
static void aurora_flush_buffer(struct tty_struct *tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_flush_buffer: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_flush_buffer"))
return;
save_flags(flags); cli();
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
restore_flags(flags);
tty_wakeup(tty);
#ifdef AURORA_DEBUG
printk("aurora_flush_buffer: end\n");
#endif
}
static int aurora_tiocmget(struct tty_struct *tty, struct file *file)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board * bp;
unsigned char status,chip;
unsigned int result;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_get_modem_info: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, __FUNCTION__))
return -ENODEV;
chip = AURORA_CD180(port_No(port));
bp = port_Board(port);
save_flags(flags); cli();
sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]);
udelay(1);
status = sbus_readb(&bp->r[chip]->r[CD180_MSVR]);
result = 0/*bp->r[chip]->r[AURORA_RI] & (1u << port_No(port)) ? 0 : TIOCM_RNG*/;
restore_flags(flags);
result |= ((status & bp->RTS) ? TIOCM_RTS : 0)
| ((status & bp->DTR) ? TIOCM_DTR : 0)
| ((status & MSVR_CD) ? TIOCM_CAR : 0)
| ((status & MSVR_DSR) ? TIOCM_DSR : 0)
| ((status & MSVR_CTS) ? TIOCM_CTS : 0);
#ifdef AURORA_DEBUG
printk("aurora_get_modem_info: end\n");
#endif
return result;
}
static int aurora_tiocmset(struct tty_struct *tty, struct file *file,
unsigned int set, unsigned int clear)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
unsigned int arg;
unsigned long flags;
struct Aurora_board *bp = port_Board(port);
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_set_modem_info: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, __FUNCTION__))
return -ENODEV;
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
if (set & TIOCM_RTS)
port->MSVR |= bp->RTS;
if (set & TIOCM_DTR)
port->MSVR |= bp->DTR;
if (clear & TIOCM_RTS)
port->MSVR &= ~bp->RTS;
if (clear & TIOCM_DTR)
port->MSVR &= ~bp->DTR;
sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_set_modem_info: end\n");
#endif
return 0;
}
static void aurora_send_break(struct Aurora_port * port, unsigned long length)
{
struct Aurora_board *bp = port_Board(port);
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_send_break: start\n");
#endif
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
port->break_length = AURORA_TPS / HZ * length;
port->COR2 |= COR2_ETC;
port->SRER |= SRER_TXRDY;
sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->COR2, &bp->r[chip]->r[CD180_COR2]);
sbus_writeb(port->SRER, &bp->r[chip]->r[CD180_SRER]);
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_CORCHG2, &bp->r[chip]->r[CD180_CCR]);
aurora_wait_CCR(bp->r[chip]);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_send_break: end\n");
#endif
}
static int aurora_set_serial_info(struct Aurora_port * port,
struct serial_struct * newinfo)
{
struct serial_struct tmp;
struct Aurora_board *bp = port_Board(port);
int change_speed;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_set_serial_info: start\n");
#endif
if (copy_from_user(&tmp, newinfo, sizeof(tmp)))
return -EFAULT;
#if 0
if ((tmp.irq != bp->irq) ||
(tmp.port != bp->base) ||
(tmp.type != PORT_CIRRUS) ||
(tmp.baud_base != (bp->oscfreq + CD180_TPC/2) / CD180_TPC) ||
(tmp.custom_divisor != 0) ||
(tmp.xmit_fifo_size != CD180_NFIFO) ||
(tmp.flags & ~AURORA_LEGAL_FLAGS))
return -EINVAL;
#endif
change_speed = ((port->flags & ASYNC_SPD_MASK) !=
(tmp.flags & ASYNC_SPD_MASK));
if (!capable(CAP_SYS_ADMIN)) {
if ((tmp.close_delay != port->close_delay) ||
(tmp.closing_wait != port->closing_wait) ||
((tmp.flags & ~ASYNC_USR_MASK) !=
(port->flags & ~ASYNC_USR_MASK)))
return -EPERM;
port->flags = ((port->flags & ~ASYNC_USR_MASK) |
(tmp.flags & ASYNC_USR_MASK));
} else {
port->flags = ((port->flags & ~ASYNC_FLAGS) |
(tmp.flags & ASYNC_FLAGS));
port->close_delay = tmp.close_delay;
port->closing_wait = tmp.closing_wait;
}
if (change_speed) {
save_flags(flags); cli();
aurora_change_speed(bp, port);
restore_flags(flags);
}
#ifdef AURORA_DEBUG
printk("aurora_set_serial_info: end\n");
#endif
return 0;
}
extern int aurora_get_serial_info(struct Aurora_port * port,
struct serial_struct * retinfo)
{
struct serial_struct tmp;
struct Aurora_board *bp = port_Board(port);
#ifdef AURORA_DEBUG
printk("aurora_get_serial_info: start\n");
#endif
if (!access_ok(VERIFY_WRITE, (void *) retinfo, sizeof(tmp)))
return -EFAULT;
memset(&tmp, 0, sizeof(tmp));
tmp.type = PORT_CIRRUS;
tmp.line = port - aurora_port;
tmp.port = 0;
tmp.irq = bp->irq;
tmp.flags = port->flags;
tmp.baud_base = (bp->oscfreq + CD180_TPC/2) / CD180_TPC;
tmp.close_delay = port->close_delay * HZ/100;
tmp.closing_wait = port->closing_wait * HZ/100;
tmp.xmit_fifo_size = CD180_NFIFO;
copy_to_user(retinfo, &tmp, sizeof(tmp));
#ifdef AURORA_DEBUG
printk("aurora_get_serial_info: end\n");
#endif
return 0;
}
static int aurora_ioctl(struct tty_struct * tty, struct file * filp,
unsigned int cmd, unsigned long arg)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
int retval;
#ifdef AURORA_DEBUG
printk("aurora_ioctl: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_ioctl"))
return -ENODEV;
switch (cmd) {
case TCSBRK: /* SVID version: non-zero arg --> no break */
retval = tty_check_change(tty);
if (retval)
return retval;
tty_wait_until_sent(tty, 0);
if (!arg)
aurora_send_break(port, HZ/4); /* 1/4 second */
return 0;
case TCSBRKP: /* support for POSIX tcsendbreak() */
retval = tty_check_change(tty);
if (retval)
return retval;
tty_wait_until_sent(tty, 0);
aurora_send_break(port, arg ? arg*(HZ/10) : HZ/4);
return 0;
case TIOCGSOFTCAR:
return put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned long *)arg);
case TIOCSSOFTCAR:
if (get_user(arg,(unsigned long *)arg))
return -EFAULT;
tty->termios->c_cflag =
((tty->termios->c_cflag & ~CLOCAL) |
(arg ? CLOCAL : 0));
return 0;
case TIOCGSERIAL:
return aurora_get_serial_info(port, (struct serial_struct *) arg);
case TIOCSSERIAL:
return aurora_set_serial_info(port, (struct serial_struct *) arg);
default:
return -ENOIOCTLCMD;
};
#ifdef AURORA_DEBUG
printk("aurora_ioctl: end\n");
#endif
return 0;
}
static void aurora_throttle(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_throttle: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_throttle"))
return;
bp = port_Board(port);
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
port->MSVR &= ~bp->RTS;
sbus_writeb(port_No(port) & 7, &bp->r[chip]->r[CD180_CAR]);
udelay(1);
if (I_IXOFF(tty)) {
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_SSCH2, &bp->r[chip]->r[CD180_CCR]);
aurora_wait_CCR(bp->r[chip]);
}
sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_throttle: end\n");
#endif
}
static void aurora_unthrottle(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_unthrottle: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_unthrottle"))
return;
bp = port_Board(port);
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
port->MSVR |= bp->RTS;
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
if (I_IXOFF(tty)) {
aurora_wait_CCR(bp->r[chip]);
sbus_writeb(CCR_SSCH1,
&bp->r[chip]->r[CD180_CCR]);
aurora_wait_CCR(bp->r[chip]);
}
sbus_writeb(port->MSVR, &bp->r[chip]->r[CD180_MSVR]);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_unthrottle: end\n");
#endif
}
static void aurora_stop(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_stop: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_stop"))
return;
bp = port_Board(port);
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
port->SRER &= ~SRER_TXRDY;
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->SRER,
&bp->r[chip]->r[CD180_SRER]);
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_stop: end\n");
#endif
}
static void aurora_start(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
unsigned long flags;
unsigned char chip;
#ifdef AURORA_DEBUG
printk("aurora_start: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_start"))
return;
bp = port_Board(port);
chip = AURORA_CD180(port_No(port));
save_flags(flags); cli();
if (port->xmit_cnt && port->xmit_buf && !(port->SRER & SRER_TXRDY)) {
port->SRER |= SRER_TXRDY;
sbus_writeb(port_No(port) & 7,
&bp->r[chip]->r[CD180_CAR]);
udelay(1);
sbus_writeb(port->SRER,
&bp->r[chip]->r[CD180_SRER]);
}
restore_flags(flags);
#ifdef AURORA_DEBUG
printk("aurora_start: end\n");
#endif
}
/*
* This routine is called from the scheduler tqueue when the interrupt
* routine has signalled that a hangup has occurred. The path of
* hangup processing is:
*
* serial interrupt routine -> (scheduler tqueue) ->
* do_aurora_hangup() -> tty->hangup() -> aurora_hangup()
*
*/
static void do_aurora_hangup(void *private_)
{
struct Aurora_port *port = (struct Aurora_port *) private_;
struct tty_struct *tty;
#ifdef AURORA_DEBUG
printk("do_aurora_hangup: start\n");
#endif
tty = port->tty;
if (tty != NULL) {
tty_hangup(tty); /* FIXME: module removal race - AKPM */
#ifdef AURORA_DEBUG
printk("do_aurora_hangup: end\n");
#endif
}
}
static void aurora_hangup(struct tty_struct * tty)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
struct Aurora_board *bp;
#ifdef AURORA_DEBUG
printk("aurora_hangup: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_hangup"))
return;
bp = port_Board(port);
aurora_shutdown_port(bp, port);
port->event = 0;
port->count = 0;
port->flags &= ~ASYNC_NORMAL_ACTIVE;
port->tty = 0;
wake_up_interruptible(&port->open_wait);
#ifdef AURORA_DEBUG
printk("aurora_hangup: end\n");
#endif
}
static void aurora_set_termios(struct tty_struct * tty, struct termios * old_termios)
{
struct Aurora_port *port = (struct Aurora_port *) tty->driver_data;
unsigned long flags;
#ifdef AURORA_DEBUG
printk("aurora_set_termios: start\n");
#endif
if ((aurora_paranoia_check(port, tty->name, "aurora_set_termios"))
return;
if (tty->termios->c_cflag == old_termios->c_cflag &&
tty->termios->c_iflag == old_termios->c_iflag)
return;
save_flags(flags); cli();
aurora_change_speed(port_Board(port), port);
restore_flags(flags);
if ((old_termios->c_cflag & CRTSCTS) &&
!(tty->termios->c_cflag & CRTSCTS)) {
tty->hw_stopped = 0;
aurora_start(tty);
}
#ifdef AURORA_DEBUG
printk("aurora_set_termios: end\n");
#endif
}
static void do_aurora_bh(void)
{
run_task_queue(&tq_aurora);
}
static void do_softint(void *private_)
{
struct Aurora_port *port = (struct Aurora_port *) private_;
struct tty_struct *tty;
#ifdef AURORA_DEBUG
printk("do_softint: start\n");
#endif
tty = port->tty;
if (tty == NULL)
return;
if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &port->event)) {
tty_wakeup(tty);
}
#ifdef AURORA_DEBUG
printk("do_softint: end\n");
#endif
}
static const struct tty_operations aurora_ops = {
.open = aurora_open,
.close = aurora_close,
.write = aurora_write,
.put_char = aurora_put_char,
.flush_chars = aurora_flush_chars,
.write_room = aurora_write_room,
.chars_in_buffer = aurora_chars_in_buffer,
.flush_buffer = aurora_flush_buffer,
.ioctl = aurora_ioctl,
.throttle = aurora_throttle,
.unthrottle = aurora_unthrottle,
.set_termios = aurora_set_termios,
.stop = aurora_stop,
.start = aurora_start,
.hangup = aurora_hangup,
.tiocmget = aurora_tiocmget,
.tiocmset = aurora_tiocmset,
};
static int aurora_init_drivers(void)
{
int error;
int i;
#ifdef AURORA_DEBUG
printk("aurora_init_drivers: start\n");
#endif
tmp_buf = (unsigned char *) get_zeroed_page(GFP_KERNEL);
if (tmp_buf == NULL) {
printk(KERN_ERR "aurora: Couldn't get free page.\n");
return 1;
}
init_bh(AURORA_BH, do_aurora_bh);
aurora_driver = alloc_tty_driver(AURORA_INPORTS);
if (!aurora_driver) {
printk(KERN_ERR "aurora: Couldn't allocate tty driver.\n");
free_page((unsigned long) tmp_buf);
return 1;
}
aurora_driver->owner = THIS_MODULE;
aurora_driver->name = "ttyA";
aurora_driver->major = AURORA_MAJOR;
aurora_driver->type = TTY_DRIVER_TYPE_SERIAL;
aurora_driver->subtype = SERIAL_TYPE_NORMAL;
aurora_driver->init_termios = tty_std_termios;
aurora_driver->init_termios.c_cflag =
B9600 | CS8 | CREAD | HUPCL | CLOCAL;
aurora_driver->flags = TTY_DRIVER_REAL_RAW;
tty_set_operations(aurora_driver, &aurora_ops);
error = tty_register_driver(aurora_driver);
if (error) {
put_tty_driver(aurora_driver);
free_page((unsigned long) tmp_buf);
printk(KERN_ERR "aurora: Couldn't register aurora driver, error = %d\n",
error);
return 1;
}
memset(aurora_port, 0, sizeof(aurora_port));
for (i = 0; i < AURORA_TNPORTS; i++) {
aurora_port[i].magic = AURORA_MAGIC;
aurora_port[i].tqueue.routine = do_softint;
aurora_port[i].tqueue.data = &aurora_port[i];
aurora_port[i].tqueue_hangup.routine = do_aurora_hangup;
aurora_port[i].tqueue_hangup.data = &aurora_port[i];
aurora_port[i].close_delay = 50 * HZ/100;
aurora_port[i].closing_wait = 3000 * HZ/100;
init_waitqueue_head(&aurora_port[i].open_wait);
init_waitqueue_head(&aurora_port[i].close_wait);
}
#ifdef AURORA_DEBUG
printk("aurora_init_drivers: end\n");
#endif
return 0;
}
static void aurora_release_drivers(void)
{
#ifdef AURORA_DEBUG
printk("aurora_release_drivers: start\n");
#endif
free_page((unsigned long)tmp_buf);
tty_unregister_driver(aurora_driver);
put_tty_driver(aurora_driver);
#ifdef AURORA_DEBUG
printk("aurora_release_drivers: end\n");
#endif
}
/*
* Called at boot time.
*
* You can specify IO base for up to RC_NBOARD cards,
* using line "riscom8=0xiobase1,0xiobase2,.." at LILO prompt.
* Note that there will be no probing at default
* addresses in this case.
*
*/
void __init aurora_setup(char *str, int *ints)
{
int i;
for(i=0;(i<ints[0])&&(i<4);i++) {
if (ints[i+1]) irqs[i]=ints[i+1];
}
}
static int __init aurora_real_init(void)
{
int found;
int i;
printk(KERN_INFO "aurora: Driver starting.\n");
if(aurora_init_drivers())
return -EIO;
found = aurora_probe();
if(!found) {
aurora_release_drivers();
printk(KERN_INFO "aurora: No Aurora Multiport boards detected.\n");
return -EIO;
} else {
printk(KERN_INFO "aurora: %d boards found.\n", found);
}
for (i = 0; i < found; i++) {
int ret = aurora_setup_board(&aurora_board[i]);
if (ret) {
#ifdef AURORA_DEBUG
printk(KERN_ERR "aurora_init: error aurora_setup_board ret %d\n",
ret);
#endif
return ret;
}
}
return 0;
}
int irq = 0;
int irq1 = 0;
int irq2 = 0;
int irq3 = 0;
module_param(irq , int, 0);
module_param(irq1, int, 0);
module_param(irq2, int, 0);
module_param(irq3, int, 0);
static int __init aurora_init(void)
{
if (irq ) irqs[0]=irq ;
if (irq1) irqs[1]=irq1;
if (irq2) irqs[2]=irq2;
if (irq3) irqs[3]=irq3;
return aurora_real_init();
}
static void __exit aurora_cleanup(void)
{
int i;
#ifdef AURORA_DEBUG
printk("cleanup_module: aurora_release_drivers\n");
#endif
aurora_release_drivers();
for (i = 0; i < AURORA_NBOARD; i++)
if (aurora_board[i].flags & AURORA_BOARD_PRESENT) {
aurora_shutdown_board(&aurora_board[i]);
aurora_release_io_range(&aurora_board[i]);
}
}
module_init(aurora_init);
module_exit(aurora_cleanup);
MODULE_LICENSE("GPL");
View Git Blame Copy Permalink