Viewing file:  isicom.c (52.19 KB) -rw-r--r--
Select action/file-type:
 (+) |  (+) |  (+) | Code (+) | Session (+) |  (+) | SDB (+) |  (+) |  (+) |  (+) |  (+) |  (+) |
/*
* 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.
*
* Original driver code supplied by Multi-Tech
*
* Changes
* 1/9/98 alan@redhat.com Merge to 2.0.x kernel tree
* Obtain and use official major/minors
* Loader switched to a misc device
* (fixed range check bug as a side effect)
* Printk clean up
* 9/12/98 alan@redhat.com Rough port to 2.1.x
*
* 10/6/99 sameer Merged the ISA and PCI drivers to
* a new unified driver.
* 09/06/01 acme@conectiva.com.br use capable, not suser, do
* restore_flags on failure in
* isicom_send_break, verify put_user
* result
* ***********************************************************
*
* To use this driver you also need the support package. You
* can find this in RPM format on
* ftp://ftp.linux.org.uk/pub/linux/alan
*
* You can find the original tools for this direct from Multitech
* ftp://ftp.multitech.com/ISI-Cards/
*
* Having installed the cards the module options (/etc/modules.conf)
*
* options isicom io=card1,card2,card3,card4 irq=card1,card2,card3,card4
*
* Omit those entries for boards you don't have installed.
*
*/
#include <linux/module.h>
#include <linux/version.h>
#include <linux/kernel.h>
#include <linux/tty.h>
#include <linux/termios.h>
#include <linux/fs.h>
#include <linux/sched.h>
#include <linux/serial.h>
#include <linux/mm.h>
#include <linux/miscdevice.h>
#include <linux/interrupt.h>
#include <linux/timer.h>
#include <linux/ioport.h>
#include <asm/segment.h>
#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/system.h>
#include <linux/pci.h>
#include <linux/isicom.h>
static struct pci_device_id isicom_pci_tbl[] = {
{ VENDOR_ID, 0x2028, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2051, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2052, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2053, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2054, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2055, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2056, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2057, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ VENDOR_ID, 0x2058, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
{ 0 }
};
MODULE_DEVICE_TABLE(pci, isicom_pci_tbl);
static int isicom_refcount;
static int prev_card = 3; /* start servicing isi_card[0] */
static struct isi_board * irq_to_board[16];
static struct tty_driver isicom_normal, isicom_callout;
static struct tty_struct * isicom_table[PORT_COUNT];
static struct termios * isicom_termios[PORT_COUNT];
static struct termios * isicom_termios_locked[PORT_COUNT];
static struct isi_board isi_card[BOARD_COUNT];
static struct isi_port isi_ports[PORT_COUNT];
DECLARE_TASK_QUEUE(tq_isicom);
static struct timer_list tx;
static char re_schedule = 1;
#ifdef ISICOM_DEBUG
static unsigned long tx_count = 0;
#endif
static int ISILoad_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg);
static void isicom_tx(unsigned long _data);
static void isicom_start(struct tty_struct * tty);
static unsigned char * tmp_buf = 0;
static DECLARE_MUTEX(tmp_buf_sem);
/* baud index mappings from linux defns to isi */
static signed char linuxb_to_isib[] = {
-1, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 11, 13, 15, 16, 17,
18, 19
};
/*
* Firmware loader driver specific routines
*
*/
static struct file_operations ISILoad_fops = {
owner: THIS_MODULE,
ioctl: ISILoad_ioctl,
};
struct miscdevice isiloader_device = {
ISILOAD_MISC_MINOR, "isictl", &ISILoad_fops
};
extern inline int WaitTillCardIsFree(unsigned short base)
{
unsigned long count=0;
while( (!(inw(base+0xe) & 0x1)) && (count++ < 6000000));
if (inw(base+0xe)&0x1)
return 0;
else
return 1;
}
static int ISILoad_ioctl(struct inode *inode, struct file *filp,
unsigned int cmd, unsigned long arg)
{
unsigned int card, i, j, signature, status, portcount = 0;
unsigned short word_count, base;
bin_frame frame;
/* exec_record exec_rec; */
if(get_user(card, (int *)arg))
return -EFAULT;
if(card < 0 || card >= BOARD_COUNT)
return -ENXIO;
base=isi_card[card].base;
if(base==0)
return -ENXIO; /* disabled or not used */
switch(cmd) {
case MIOCTL_RESET_CARD:
if (!capable(CAP_SYS_ADMIN))
return -EPERM;
printk(KERN_DEBUG "ISILoad:Resetting Card%d at 0x%x ",card+1,base);
inw(base+0x8);
for(i=jiffies+HZ/100;time_before(jiffies, i););
outw(0,base+0x8); /* Reset */
for(j=1;j<=3;j++) {
for(i=jiffies+HZ;time_before(jiffies, i););
printk(".");
}
signature=(inw(base+0x4)) & 0xff;
if (isi_card[card].isa) {
if (!(inw(base+0xe) & 0x1) || (inw(base+0x2))) {
#ifdef ISICOM_DEBUG
printk("\nbase+0x2=0x%x , base+0xe=0x%x",inw(base+0x2),inw(base+0xe));
#endif
printk("\nISILoad:ISA Card%d reset failure (Possible bad I/O Port Address 0x%x).\n",card+1,base);
return -EIO;
}
}
else {
portcount = inw(base+0x2);
if (!(inw(base+0xe) & 0x1) || ((portcount!=0) && (portcount!=4) && (portcount!=8))) {
#ifdef ISICOM_DEBUG
printk("\nbase+0x2=0x%x , base+0xe=0x%x",inw(base+0x2),inw(base+0xe));
#endif
printk("\nISILoad:PCI Card%d reset failure (Possible bad I/O Port Address 0x%x).\n",card+1,base);
return -EIO;
}
}
switch(signature) {
case 0xa5:
case 0xbb:
case 0xdd:
if (isi_card[card].isa)
isi_card[card].port_count = 8;
else {
if (portcount == 4)
isi_card[card].port_count = 4;
else
isi_card[card].port_count = 8;
}
isi_card[card].shift_count = 12;
break;
case 0xcc: isi_card[card].port_count = 16;
isi_card[card].shift_count = 11;
break;
default: printk("ISILoad:Card%d reset failure (Possible bad I/O Port Address 0x%x).\n",card+1,base);
#ifdef ISICOM_DEBUG
printk("Sig=0x%x\n",signature);
#endif
return -EIO;
}
printk("-Done\n");
return put_user(signature,(unsigned int*)arg);
case MIOCTL_LOAD_FIRMWARE:
if (!capable(CAP_SYS_ADMIN))
return -EPERM;
if(copy_from_user(&frame, (void *) arg, sizeof(bin_frame)))
return -EFAULT;
if (WaitTillCardIsFree(base))
return -EIO;
outw(0xf0,base); /* start upload sequence */
outw(0x00,base);
outw((frame.addr), base);/* lsb of adderess */
word_count=(frame.count >> 1) + frame.count % 2;
outw(word_count, base);
InterruptTheCard(base);
for(i=0;i<=0x2f;i++); /* a wee bit of delay */
if (WaitTillCardIsFree(base))
return -EIO;
if ((status=inw(base+0x4))!=0) {
printk(KERN_WARNING "ISILoad:Card%d rejected load header:\nAddress:0x%x \nCount:0x%x \nStatus:0x%x \n",
card+1, frame.addr, frame.count, status);
return -EIO;
}
outsw(base, (void *) frame.bin_data, word_count);
InterruptTheCard(base);
for(i=0;i<=0x0f;i++); /* another wee bit of delay */
if (WaitTillCardIsFree(base))
return -EIO;
if ((status=inw(base+0x4))!=0) {
printk(KERN_ERR "ISILoad:Card%d got out of sync.Card Status:0x%x\n",card+1, status);
return -EIO;
}
return 0;
case MIOCTL_READ_FIRMWARE:
if (!capable(CAP_SYS_ADMIN))
return -EPERM;
if(copy_from_user(&frame, (void *) arg, sizeof(bin_header)))
return -EFAULT;
if (WaitTillCardIsFree(base))
return -EIO;
outw(0xf1,base); /* start download sequence */
outw(0x00,base);
outw((frame.addr), base);/* lsb of adderess */
word_count=(frame.count >> 1) + frame.count % 2;
outw(word_count+1, base);
InterruptTheCard(base);
for(i=0;i<=0xf;i++); /* a wee bit of delay */
if (WaitTillCardIsFree(base))
return -EIO;
if ((status=inw(base+0x4))!=0) {
printk(KERN_WARNING "ISILoad:Card%d rejected verify header:\nAddress:0x%x \nCount:0x%x \nStatus:0x%x \n",
card+1, frame.addr, frame.count, status);
return -EIO;
}
inw(base);
insw(base, frame.bin_data, word_count);
InterruptTheCard(base);
for(i=0;i<=0x0f;i++); /* another wee bit of delay */
if (WaitTillCardIsFree(base))
return -EIO;
if ((status=inw(base+0x4))!=0) {
printk(KERN_ERR "ISILoad:Card%d verify got out of sync.Card Status:0x%x\n",card+1, status);
return -EIO;
}
if(copy_to_user((void *) arg, &frame, sizeof(bin_frame)))
return -EFAULT;
return 0;
case MIOCTL_XFER_CTRL:
if (!capable(CAP_SYS_ADMIN))
return -EPERM;
if (WaitTillCardIsFree(base))
return -EIO;
outw(0xf2, base);
outw(0x800, base);
outw(0x0, base);
outw(0x0, base);
InterruptTheCard(base);
outw(0x0, base+0x4); /* for ISI4608 cards */
isi_card[card].status |= FIRMWARE_LOADED;
return 0;
default:
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISILoad: Received Ioctl cmd 0x%x.\n", cmd);
#endif
return -ENOIOCTLCMD;
}
}
/*
* ISICOM Driver specific routines ...
*
*/
static inline int isicom_paranoia_check(struct isi_port const * port, kdev_t dev,
const char * routine)
{
#ifdef ISICOM_DEBUG
static const char * badmagic =
KERN_WARNING "ISICOM: Warning: bad isicom magic for dev %s in %s.\n";
static const char * badport =
KERN_WARNING "ISICOM: Warning: NULL isicom port for dev %s in %s.\n";
if (!port) {
printk(badport, kdevname(dev), routine);
return 1;
}
if (port->magic != ISICOM_MAGIC) {
printk(badmagic, kdevname(dev), routine);
return 1;
}
#endif
return 0;
}
extern inline void schedule_bh(struct isi_port * port)
{
queue_task(&port->bh_tqueue, &tq_isicom);
mark_bh(ISICOM_BH);
}
/* Transmitter */
static void isicom_tx(unsigned long _data)
{
short count = (BOARD_COUNT-1), card, base;
short txcount, wait, wrd, residue, word_count, cnt;
struct isi_port * port;
struct tty_struct * tty;
unsigned long flags;
#ifdef ISICOM_DEBUG
++tx_count;
#endif
/* find next active board */
card = (prev_card + 1) & 0x0003;
while(count-- > 0) {
if (isi_card[card].status & BOARD_ACTIVE)
break;
card = (card + 1) & 0x0003;
}
if (!(isi_card[card].status & BOARD_ACTIVE))
goto sched_again;
prev_card = card;
count = isi_card[card].port_count;
port = isi_card[card].ports;
base = isi_card[card].base;
for (;count > 0;count--, port++) {
/* port not active or tx disabled to force flow control */
if (!(port->status & ISI_TXOK))
continue;
tty = port->tty;
save_flags(flags); cli();
txcount = MIN(TX_SIZE, port->xmit_cnt);
if ((txcount <= 0) || tty->stopped || tty->hw_stopped) {
restore_flags(flags);
continue;
}
wait = 200;
while(((inw(base+0x0e) & 0x01) == 0) && (wait-- > 0));
if (wait <= 0) {
restore_flags(flags);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_tx:Card(0x%x) found busy.\n",
card);
#endif
continue;
}
if (!(inw(base + 0x02) & (1 << port->channel))) {
restore_flags(flags);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_tx: cannot tx to 0x%x:%d.\n",
base, port->channel + 1);
#endif
continue;
}
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: txing %d bytes, port%d.\n",
txcount, port->channel+1);
#endif
outw((port->channel << isi_card[card].shift_count) | txcount
, base);
residue = NO;
wrd = 0;
while (1) {
cnt = MIN(txcount, (SERIAL_XMIT_SIZE - port->xmit_tail));
if (residue == YES) {
residue = NO;
if (cnt > 0) {
wrd |= (port->xmit_buf[port->xmit_tail] << 8);
port->xmit_tail = (port->xmit_tail + 1) & (SERIAL_XMIT_SIZE - 1);
port->xmit_cnt--;
txcount--;
cnt--;
outw(wrd, base);
}
else {
outw(wrd, base);
break;
}
}
if (cnt <= 0) break;
word_count = cnt >> 1;
outsw(base, port->xmit_buf+port->xmit_tail, word_count);
port->xmit_tail = (port->xmit_tail + (word_count << 1)) &
(SERIAL_XMIT_SIZE - 1);
txcount -= (word_count << 1);
port->xmit_cnt -= (word_count << 1);
if (cnt & 0x0001) {
residue = YES;
wrd = port->xmit_buf[port->xmit_tail];
port->xmit_tail = (port->xmit_tail + 1) & (SERIAL_XMIT_SIZE - 1);
port->xmit_cnt--;
txcount--;
}
}
InterruptTheCard(base);
if (port->xmit_cnt <= 0)
port->status &= ~ISI_TXOK;
if (port->xmit_cnt <= WAKEUP_CHARS)
schedule_bh(port);
restore_flags(flags);
}
/* schedule another tx for hopefully in about 10ms */
sched_again:
if (!re_schedule)
return;
init_timer(&tx);
tx.expires = jiffies + HZ/100;
tx.data = 0;
tx.function = isicom_tx;
add_timer(&tx);
return;
}
/* Interrupt handlers */
static void do_isicom_bh(void)
{
run_task_queue(&tq_isicom);
}
static void isicom_bottomhalf(void * data)
{
struct isi_port * port = (struct isi_port *) data;
struct tty_struct * tty = port->tty;
if (!tty)
return;
if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
tty->ldisc.write_wakeup)
(tty->ldisc.write_wakeup)(tty);
wake_up_interruptible(&tty->write_wait);
}
/* main interrupt handler routine */
static void isicom_interrupt(int irq, void * dev_id, struct pt_regs * regs)
{
struct isi_board * card;
struct isi_port * port;
struct tty_struct * tty;
unsigned short base, header, word_count, count;
unsigned char channel;
short byte_count;
/*
* find the source of interrupt
*/
for(count = 0; count < BOARD_COUNT; count++) {
card = &isi_card[count];
if (card->base != 0) {
if (((card->isa == YES) && (card->irq == irq)) ||
((card->isa == NO) && (card->irq == irq) && (inw(card->base+0x0e) & 0x02)))
break;
}
card = NULL;
}
if (!card || !(card->status & FIRMWARE_LOADED)) {
/* printk(KERN_DEBUG "ISICOM: interrupt: not handling irq%d!.\n", irq);*/
return;
}
base = card->base;
if (card->isa == NO) {
/*
* disable any interrupts from the PCI card and lower the
* interrupt line
*/
outw(0x8000, base+0x04);
ClearInterrupt(base);
}
inw(base); /* get the dummy word out */
header = inw(base);
channel = (header & 0x7800) >> card->shift_count;
byte_count = header & 0xff;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM:Intr:(0x%x:%d).\n", base, channel+1);
#endif
if ((channel+1) > card->port_count) {
printk(KERN_WARNING "ISICOM: isicom_interrupt(0x%x): %d(channel) > port_count.\n",
base, channel+1);
if (card->isa)
ClearInterrupt(base);
else
outw(0x0000, base+0x04); /* enable interrupts */
return;
}
port = card->ports + channel;
if (!(port->flags & ASYNC_INITIALIZED)) {
if (card->isa)
ClearInterrupt(base);
else
outw(0x0000, base+0x04); /* enable interrupts */
return;
}
tty = port->tty;
if (header & 0x8000) { /* Status Packet */
header = inw(base);
switch(header & 0xff) {
case 0: /* Change in EIA signals */
if (port->flags & ASYNC_CHECK_CD) {
if (port->status & ISI_DCD) {
if (!(header & ISI_DCD)) {
/* Carrier has been lost */
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: interrupt: DCD->low.\n");
#endif
port->status &= ~ISI_DCD;
if (!((port->flags & ASYNC_CALLOUT_ACTIVE) &&
(port->flags & ASYNC_CALLOUT_NOHUP))) {
MOD_INC_USE_COUNT;
if (schedule_task(&port->hangup_tq) == 0)
MOD_DEC_USE_COUNT;
}
}
}
else {
if (header & ISI_DCD) {
/* Carrier has been detected */
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: interrupt: DCD->high.\n");
#endif
port->status |= ISI_DCD;
wake_up_interruptible(&port->open_wait);
}
}
}
else {
if (header & ISI_DCD)
port->status |= ISI_DCD;
else
port->status &= ~ISI_DCD;
}
if (port->flags & ASYNC_CTS_FLOW) {
if (port->tty->hw_stopped) {
if (header & ISI_CTS) {
port->tty->hw_stopped = 0;
/* start tx ing */
port->status |= (ISI_TXOK | ISI_CTS);
schedule_bh(port);
}
}
else {
if (!(header & ISI_CTS)) {
port->tty->hw_stopped = 1;
/* stop tx ing */
port->status &= ~(ISI_TXOK | ISI_CTS);
}
}
}
else {
if (header & ISI_CTS)
port->status |= ISI_CTS;
else
port->status &= ~ISI_CTS;
}
if (header & ISI_DSR)
port->status |= ISI_DSR;
else
port->status &= ~ISI_DSR;
if (header & ISI_RI)
port->status |= ISI_RI;
else
port->status &= ~ISI_RI;
break;
case 1: /* Received Break !!! */
if (tty->flip.count >= TTY_FLIPBUF_SIZE)
break;
*tty->flip.flag_buf_ptr++ = TTY_BREAK;
/* dunno if this is right */
*tty->flip.char_buf_ptr++ = 0;
tty->flip.count++;
if (port->flags & ASYNC_SAK)
do_SAK(tty);
queue_task(&tty->flip.tqueue, &tq_timer);
break;
case 2: /* Statistics */
printk(KERN_DEBUG "ISICOM: isicom_interrupt: stats!!!.\n");
break;
default:
printk(KERN_WARNING "ISICOM: Intr: Unknown code in status packet.\n");
break;
}
}
else { /* Data Packet */
count = MIN(byte_count, (TTY_FLIPBUF_SIZE - tty->flip.count));
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: Intr: Can rx %d of %d bytes.\n",
count, byte_count);
#endif
word_count = count >> 1;
insw(base, tty->flip.char_buf_ptr, word_count);
tty->flip.char_buf_ptr += (word_count << 1);
byte_count -= (word_count << 1);
if (count & 0x0001) {
*tty->flip.char_buf_ptr++ = (char)(inw(base) & 0xff);
byte_count -= 2;
}
memset(tty->flip.flag_buf_ptr, 0, count);
tty->flip.flag_buf_ptr += count;
tty->flip.count += count;
if (byte_count > 0) {
printk(KERN_DEBUG "ISICOM: Intr(0x%x:%d): Flip buffer overflow! dropping bytes...\n",
base, channel+1);
while(byte_count > 0) { /* drain out unread xtra data */
inw(base);
byte_count -= 2;
}
}
queue_task(&tty->flip.tqueue, &tq_timer);
}
if (card->isa == YES)
ClearInterrupt(base);
else
outw(0x0000, base+0x04); /* enable interrupts */
return;
}
/* called with interrupts disabled */
static void isicom_config_port(struct isi_port * port)
{
struct isi_board * card = port->card;
struct tty_struct * tty;
unsigned long baud;
unsigned short channel_setup, wait, base = card->base;
unsigned short channel = port->channel, shift_count = card->shift_count;
unsigned char flow_ctrl;
if (!(tty = port->tty) || !tty->termios)
return;
baud = C_BAUD(tty);
if (baud & CBAUDEX) {
baud &= ~CBAUDEX;
/* if CBAUDEX bit is on and the baud is set to either 50 or 75
* then the card is programmed for 57.6Kbps or 115Kbps
* respectively.
*/
if (baud < 1 || baud > 2)
port->tty->termios->c_cflag &= ~CBAUDEX;
else
baud += 15;
}
if (baud == 15) {
/* the ASYNC_SPD_HI and ASYNC_SPD_VHI options are set
* by the set_serial_info ioctl ... this is done by
* the 'setserial' utility.
*/
if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
baud++; /* 57.6 Kbps */
if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
baud +=2; /* 115 Kbps */
}
if (linuxb_to_isib[baud] == -1) {
/* hang up */
drop_dtr(port);
return;
}
else
raise_dtr(port);
wait = 100;
while (((inw(base + 0x0e) & 0x0001) == 0) && (wait-- > 0));
if (!wait) {
printk(KERN_WARNING "ISICOM: Card found busy in isicom_config_port at channel setup.\n");
return;
}
outw(0x8000 | (channel << shift_count) |0x03, base);
outw(linuxb_to_isib[baud] << 8 | 0x03, base);
channel_setup = 0;
switch(C_CSIZE(tty)) {
case CS5:
channel_setup |= ISICOM_CS5;
break;
case CS6:
channel_setup |= ISICOM_CS6;
break;
case CS7:
channel_setup |= ISICOM_CS7;
break;
case CS8:
channel_setup |= ISICOM_CS8;
break;
}
if (C_CSTOPB(tty))
channel_setup |= ISICOM_2SB;
if (C_PARENB(tty))
channel_setup |= ISICOM_EVPAR;
if (C_PARODD(tty))
channel_setup |= ISICOM_ODPAR;
outw(channel_setup, base);
InterruptTheCard(base);
if (C_CLOCAL(tty))
port->flags &= ~ASYNC_CHECK_CD;
else
port->flags |= ASYNC_CHECK_CD;
/* flow control settings ...*/
flow_ctrl = 0;
port->flags &= ~ASYNC_CTS_FLOW;
if (C_CRTSCTS(tty)) {
port->flags |= ASYNC_CTS_FLOW;
flow_ctrl |= ISICOM_CTSRTS;
}
if (I_IXON(tty))
flow_ctrl |= ISICOM_RESPOND_XONXOFF;
if (I_IXOFF(tty))
flow_ctrl |= ISICOM_INITIATE_XONXOFF;
wait = 100;
while (((inw(base + 0x0e) & 0x0001) == 0) && (wait-- > 0));
if (!wait) {
printk(KERN_WARNING "ISICOM: Card found busy in isicom_config_port at flow setup.\n");
return;
}
outw(0x8000 | (channel << shift_count) |0x04, base);
outw(flow_ctrl << 8 | 0x05, base);
outw((STOP_CHAR(tty)) << 8 | (START_CHAR(tty)), base);
InterruptTheCard(base);
/* rx enabled -> enable port for rx on the card */
if (C_CREAD(tty)) {
card->port_status |= (1 << channel);
outw(card->port_status, base + 0x02);
}
}
/* open et all */
extern inline void isicom_setup_board(struct isi_board * bp)
{
int channel;
struct isi_port * port;
unsigned long flags;
if (bp->status & BOARD_ACTIVE)
return;
port = bp->ports;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: setup_board: drop_dtr_rts start, port_count %d...\n", bp->port_count);
#endif
for(channel = 0; channel < bp->port_count; channel++, port++) {
save_flags(flags); cli();
drop_dtr_rts(port);
restore_flags(flags);
}
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: setup_board: drop_dtr_rts stop...\n");
#endif
bp->status |= BOARD_ACTIVE;
MOD_INC_USE_COUNT;
return;
}
static int isicom_setup_port(struct isi_port * port)
{
struct isi_board * card = port->card;
unsigned long flags;
if (port->flags & ASYNC_INITIALIZED)
return 0;
if (!port->xmit_buf) {
unsigned long page;
if (!(page = get_free_page(GFP_KERNEL)))
return -ENOMEM;
if (port->xmit_buf) {
free_page(page);
return -ERESTARTSYS;
}
port->xmit_buf = (unsigned char *) page;
}
save_flags(flags); cli();
if (port->tty)
clear_bit(TTY_IO_ERROR, &port->tty->flags);
if (port->count == 1)
card->count++;
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
/* discard any residual data */
kill_queue(port, ISICOM_KILLTX | ISICOM_KILLRX);
isicom_config_port(port);
port->flags |= ASYNC_INITIALIZED;
restore_flags(flags);
return 0;
}
static int block_til_ready(struct tty_struct * tty, struct file * filp, struct isi_port * port)
{
int do_clocal = 0, retval;
DECLARE_WAITQUEUE(wait, current);
/* block if port is in the process of being closed */
if (tty_hung_up_p(filp) || port->flags & ASYNC_CLOSING) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: close in progress.\n");
#endif
interruptible_sleep_on(&port->close_wait);
if (port->flags & ASYNC_HUP_NOTIFY)
return -EAGAIN;
else
return -ERESTARTSYS;
}
/* trying to open a callout device... check for constraints */
if (tty->driver.subtype == SERIAL_TYPE_CALLOUT) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: bl_ti_rdy: callout open.\n");
#endif
if (port->flags & ASYNC_NORMAL_ACTIVE)
return -EBUSY;
if ((port->flags & ASYNC_CALLOUT_ACTIVE) &&
(port->flags & ASYNC_SESSION_LOCKOUT) &&
(port->session != current->session))
return -EBUSY;
if ((port->flags & ASYNC_CALLOUT_ACTIVE) &&
(port->flags & ASYNC_PGRP_LOCKOUT) &&
(port->pgrp != current->pgrp))
return -EBUSY;
port->flags |= ASYNC_CALLOUT_ACTIVE;
cli();
raise_dtr_rts(port);
sti();
return 0;
}
/* if non-blocking mode is set ... */
if ((filp->f_flags & O_NONBLOCK) || (tty->flags & (1 << TTY_IO_ERROR))) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: non-block mode.\n");
#endif
if (port->flags & ASYNC_CALLOUT_ACTIVE)
return -EBUSY;
port->flags |= ASYNC_NORMAL_ACTIVE;
return 0;
}
if (port->flags & ASYNC_CALLOUT_ACTIVE) {
if (port->normal_termios.c_cflag & CLOCAL)
do_clocal = 1;
} else {
if (C_CLOCAL(tty))
do_clocal = 1;
}
#ifdef ISICOM_DEBUG
if (do_clocal)
printk(KERN_DEBUG "ISICOM: block_til_ready: CLOCAL set.\n");
#endif
/* block waiting for DCD to be asserted, and while
callout dev is busy */
retval = 0;
add_wait_queue(&port->open_wait, &wait);
cli();
if (!tty_hung_up_p(filp))
port->count--;
sti();
port->blocked_open++;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: waiting for DCD...\n");
#endif
while (1) {
cli();
if (!(port->flags & ASYNC_CALLOUT_ACTIVE))
raise_dtr_rts(port);
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;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: tty_hung_up_p || not init.\n");
#endif
break;
}
if (!(port->flags & ASYNC_CALLOUT_ACTIVE) &&
!(port->flags & ASYNC_CLOSING) &&
(do_clocal || (port->status & ISI_DCD))) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: do_clocal || DCD.\n");
#endif
break;
}
if (signal_pending(current)) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready: sig blocked.\n");
#endif
retval = -ERESTARTSYS;
break;
}
schedule();
}
set_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;
return 0;
}
static int isicom_open(struct tty_struct * tty, struct file * filp)
{
struct isi_port * port;
struct isi_board * card;
unsigned int line, board;
unsigned long flags;
int error;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: open start!!!.\n");
#endif
line = MINOR(tty->device) - tty->driver.minor_start;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "line = %d.\n", line);
#endif
if ((line < 0) || (line > (PORT_COUNT-1)))
return -ENODEV;
board = BOARD(line);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "board = %d.\n", board);
#endif
card = &isi_card[board];
if (!(card->status & FIRMWARE_LOADED)) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG"ISICOM: Firmware not loaded to card%d.\n", board);
#endif
return -ENODEV;
}
/* open on a port greater than the port count for the card !!! */
if (line > ((board * 16) + card->port_count - 1)) {
printk(KERN_ERR "ISICOM: Open on a port which exceeds the port_count of the card!\n");
return -ENODEV;
}
port = &isi_ports[line];
if (isicom_paranoia_check(port, tty->device, "isicom_open"))
return -ENODEV;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_setup_board ...\n");
#endif
isicom_setup_board(card);
port->count++;
tty->driver_data = port;
port->tty = tty;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_setup_port ...\n");
#endif
if ((error = isicom_setup_port(port))!=0)
return error;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: block_til_ready ...\n");
#endif
if ((error = block_til_ready(tty, filp, port))!=0)
return error;
if ((port->count == 1) && (port->flags & ASYNC_SPLIT_TERMIOS)) {
if (tty->driver.subtype == SERIAL_TYPE_NORMAL)
*tty->termios = port->normal_termios;
else
*tty->termios = port->callout_termios;
save_flags(flags); cli();
isicom_config_port(port);
restore_flags(flags);
}
port->session = current->session;
port->pgrp = current->pgrp;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: open end!!!.\n");
#endif
return 0;
}
/* close et all */
extern inline void isicom_shutdown_board(struct isi_board * bp)
{
int channel;
struct isi_port * port;
if (!(bp->status & BOARD_ACTIVE))
return;
bp->status &= ~BOARD_ACTIVE;
port = bp->ports;
for(channel = 0; channel < bp->port_count; channel++, port++) {
drop_dtr_rts(port);
}
MOD_DEC_USE_COUNT;
}
static void isicom_shutdown_port(struct isi_port * port)
{
struct isi_board * card = port->card;
struct tty_struct * tty;
if (!(port->flags & ASYNC_INITIALIZED))
return;
if (port->xmit_buf) {
free_page((unsigned long) port->xmit_buf);
port->xmit_buf = NULL;
}
if (!(tty = port->tty) || C_HUPCL(tty))
/* drop dtr on this port */
drop_dtr(port);
/* any other port uninits */
if (tty)
set_bit(TTY_IO_ERROR, &tty->flags);
port->flags &= ~ASYNC_INITIALIZED;
if (--card->count < 0) {
printk(KERN_DEBUG "ISICOM: isicom_shutdown_port: bad board(0x%x) count %d.\n",
card->base, card->count);
card->count = 0;
}
/* last port was closed , shutdown that boad too */
if (!card->count)
isicom_shutdown_board(card);
}
static void isicom_close(struct tty_struct * tty, struct file * filp)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
struct isi_board * card = port->card;
unsigned long flags;
if (!port)
return;
if (isicom_paranoia_check(port, tty->device, "isicom_close"))
return;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: Close start!!!.\n");
#endif
save_flags(flags); cli();
if (tty_hung_up_p(filp)) {
restore_flags(flags);
return;
}
if ((tty->count == 1) && (port->count != 1)) {
printk(KERN_WARNING "ISICOM:(0x%x) isicom_close: bad port count"
"tty->count = 1 port count = %d.\n",
card->base, port->count);
port->count = 1;
}
if (--port->count < 0) {
printk(KERN_WARNING "ISICOM:(0x%x) isicom_close: bad port count for"
"channel%d = %d", card->base, port->channel,
port->count);
port->count = 0;
}
if (port->count) {
restore_flags(flags);
return;
}
port->flags |= ASYNC_CLOSING;
/*
* save termios struct since callout and dialin termios may be
* different.
*/
if (port->flags & ASYNC_NORMAL_ACTIVE)
port->normal_termios = *tty->termios;
if (port->flags & ASYNC_CALLOUT_ACTIVE)
port->callout_termios = *tty->termios;
tty->closing = 1;
if (port->closing_wait != ASYNC_CLOSING_WAIT_NONE)
tty_wait_until_sent(tty, port->closing_wait);
/* indicate to the card that no more data can be received
on this port */
if (port->flags & ASYNC_INITIALIZED) {
card->port_status &= ~(1 << port->channel);
outw(card->port_status, card->base + 0x02);
}
isicom_shutdown_port(port);
if (tty->driver.flush_buffer)
tty->driver.flush_buffer(tty);
if (tty->ldisc.flush_buffer)
tty->ldisc.flush_buffer(tty);
tty->closing = 0;
port->tty = 0;
if (port->blocked_open) {
if (port->close_delay) {
set_current_state(TASK_INTERRUPTIBLE);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: scheduling until time out.\n");
#endif
schedule_timeout(port->close_delay);
}
wake_up_interruptible(&port->open_wait);
}
port->flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CALLOUT_ACTIVE |
ASYNC_CLOSING);
wake_up_interruptible(&port->close_wait);
restore_flags(flags);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: Close end!!!.\n");
#endif
}
/* write et all */
static int isicom_write(struct tty_struct * tty, int from_user,
const unsigned char * buf, int count)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
unsigned long flags;
int cnt, total = 0;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_write for port%d: %d bytes.\n",
port->channel+1, count);
#endif
if (isicom_paranoia_check(port, tty->device, "isicom_write"))
return 0;
if (!tty || !port->xmit_buf || !tmp_buf)
return 0;
if (from_user)
down(&tmp_buf_sem); /* acquire xclusive access to tmp_buf */
save_flags(flags);
while(1) {
cli();
cnt = MIN(count, MIN(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
SERIAL_XMIT_SIZE - port->xmit_head));
if (cnt <= 0)
break;
if (from_user) {
/* the following may block for paging... hence
enabling interrupts but tx routine may have
created more space in xmit_buf when the ctrl
gets back here */
sti();
copy_from_user(tmp_buf, buf, cnt);
cli();
cnt = MIN(cnt, MIN(SERIAL_XMIT_SIZE - port->xmit_cnt - 1,
SERIAL_XMIT_SIZE - port->xmit_head));
memcpy(port->xmit_buf + port->xmit_head, tmp_buf, cnt);
}
else
memcpy(port->xmit_buf + port->xmit_head, buf, cnt);
port->xmit_head = (port->xmit_head + cnt) & (SERIAL_XMIT_SIZE - 1);
port->xmit_cnt += cnt;
restore_flags(flags);
buf += cnt;
count -= cnt;
total += cnt;
}
if (from_user)
up(&tmp_buf_sem);
if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped)
port->status |= ISI_TXOK;
restore_flags(flags);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: isicom_write %d bytes written.\n", total);
#endif
return total;
}
/* put_char et all */
static void isicom_put_char(struct tty_struct * tty, unsigned char ch)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
unsigned long flags;
if (isicom_paranoia_check(port, tty->device, "isicom_put_char"))
return;
if (!tty || !port->xmit_buf)
return;
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: put_char, port %d, char %c.\n", port->channel+1, ch);
#endif
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);
}
/* flush_chars et all */
static void isicom_flush_chars(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
if (isicom_paranoia_check(port, tty->device, "isicom_flush_chars"))
return;
if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
!port->xmit_buf)
return;
/* this tells the transmitter to consider this port for
data output to the card ... that's the best we can do. */
port->status |= ISI_TXOK;
}
/* write_room et all */
static int isicom_write_room(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
int free;
if (isicom_paranoia_check(port, tty->device, "isicom_write_room"))
return 0;
free = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
if (free < 0)
free = 0;
return free;
}
/* chars_in_buffer et all */
static int isicom_chars_in_buffer(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
if (isicom_paranoia_check(port, tty->device, "isicom_chars_in_buffer"))
return 0;
return port->xmit_cnt;
}
/* ioctl et all */
extern inline void isicom_send_break(struct isi_port * port, unsigned long length)
{
struct isi_board * card = port->card;
short wait = 10;
unsigned short base = card->base;
unsigned long flags;
save_flags(flags); cli();
while (((inw(base + 0x0e) & 0x0001) == 0) && (wait-- > 0));
if (!wait) {
printk(KERN_DEBUG "ISICOM: Card found busy in isicom_send_break.\n");
goto out;
}
outw(0x8000 | ((port->channel) << (card->shift_count)) | 0x3, base);
outw((length & 0xff) << 8 | 0x00, base);
outw((length & 0xff00), base);
InterruptTheCard(base);
out: restore_flags(flags);
}
static int isicom_get_modem_info(struct isi_port * port, unsigned int * value)
{
/* just send the port status */
unsigned int info;
unsigned short status = port->status;
info = ((status & ISI_RTS) ? TIOCM_RTS : 0) |
((status & ISI_DTR) ? TIOCM_DTR : 0) |
((status & ISI_DCD) ? TIOCM_CAR : 0) |
((status & ISI_DSR) ? TIOCM_DSR : 0) |
((status & ISI_CTS) ? TIOCM_CTS : 0) |
((status & ISI_RI ) ? TIOCM_RI : 0);
return put_user(info, (unsigned int *) value);
}
static int isicom_set_modem_info(struct isi_port * port, unsigned int cmd,
unsigned int * value)
{
unsigned int arg;
unsigned long flags;
if(get_user(arg, value))
return -EFAULT;
save_flags(flags); cli();
switch(cmd) {
case TIOCMBIS:
if (arg & TIOCM_RTS)
raise_rts(port);
if (arg & TIOCM_DTR)
raise_dtr(port);
break;
case TIOCMBIC:
if (arg & TIOCM_RTS)
drop_rts(port);
if (arg & TIOCM_DTR)
drop_dtr(port);
break;
case TIOCMSET:
if (arg & TIOCM_RTS)
raise_rts(port);
else
drop_rts(port);
if (arg & TIOCM_DTR)
raise_dtr(port);
else
drop_dtr(port);
break;
default:
restore_flags(flags);
return -EINVAL;
}
restore_flags(flags);
return 0;
}
static int isicom_set_serial_info(struct isi_port * port,
struct serial_struct * info)
{
struct serial_struct newinfo;
unsigned long flags;
int reconfig_port;
if(copy_from_user(&newinfo, info, sizeof(newinfo)))
return -EFAULT;
reconfig_port = ((port->flags & ASYNC_SPD_MASK) !=
(newinfo.flags & ASYNC_SPD_MASK));
if (!capable(CAP_SYS_ADMIN)) {
if ((newinfo.close_delay != port->close_delay) ||
(newinfo.closing_wait != port->closing_wait) ||
((newinfo.flags & ~ASYNC_USR_MASK) !=
(port->flags & ~ASYNC_USR_MASK)))
return -EPERM;
port->flags = ((port->flags & ~ ASYNC_USR_MASK) |
(newinfo.flags & ASYNC_USR_MASK));
}
else {
port->close_delay = newinfo.close_delay;
port->closing_wait = newinfo.closing_wait;
port->flags = ((port->flags & ~ASYNC_FLAGS) |
(newinfo.flags & ASYNC_FLAGS));
}
if (reconfig_port) {
save_flags(flags); cli();
isicom_config_port(port);
restore_flags(flags);
}
return 0;
}
static int isicom_get_serial_info(struct isi_port * port,
struct serial_struct * info)
{
struct serial_struct out_info;
memset(&out_info, 0, sizeof(out_info));
/* out_info.type = ? */
out_info.line = port - isi_ports;
out_info.port = port->card->base;
out_info.irq = port->card->irq;
out_info.flags = port->flags;
/* out_info.baud_base = ? */
out_info.close_delay = port->close_delay;
out_info.closing_wait = port->closing_wait;
if(copy_to_user(info, &out_info, sizeof(out_info)))
return -EFAULT;
return 0;
}
static int isicom_ioctl(struct tty_struct * tty, struct file * filp,
unsigned int cmd, unsigned long arg)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
int retval;
if (isicom_paranoia_check(port, tty->device, "isicom_ioctl"))
return -ENODEV;
switch(cmd) {
case TCSBRK:
retval = tty_check_change(tty);
if (retval)
return retval;
tty_wait_until_sent(tty, 0);
if (!arg)
isicom_send_break(port, HZ/4);
return 0;
case TCSBRKP:
retval = tty_check_change(tty);
if (retval)
return retval;
tty_wait_until_sent(tty, 0);
isicom_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 TIOCMGET:
return isicom_get_modem_info(port, (unsigned int*) arg);
case TIOCMBIS:
case TIOCMBIC:
case TIOCMSET:
return isicom_set_modem_info(port, cmd,
(unsigned int *) arg);
case TIOCGSERIAL:
return isicom_get_serial_info(port,
(struct serial_struct *) arg);
case TIOCSSERIAL:
return isicom_set_serial_info(port,
(struct serial_struct *) arg);
default:
return -ENOIOCTLCMD;
}
return 0;
}
/* set_termios et all */
static void isicom_set_termios(struct tty_struct * tty, struct termios * old_termios)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
unsigned long flags;
if (isicom_paranoia_check(port, tty->device, "isicom_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();
isicom_config_port(port);
restore_flags(flags);
if ((old_termios->c_cflag & CRTSCTS) &&
!(tty->termios->c_cflag & CRTSCTS)) {
tty->hw_stopped = 0;
isicom_start(tty);
}
}
/* throttle et all */
static void isicom_throttle(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
struct isi_board * card = port->card;
unsigned long flags;
if (isicom_paranoia_check(port, tty->device, "isicom_throttle"))
return;
/* tell the card that this port cannot handle any more data for now */
save_flags(flags); cli();
card->port_status &= ~(1 << port->channel);
outw(card->port_status, card->base + 0x02);
restore_flags(flags);
}
/* unthrottle et all */
static void isicom_unthrottle(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
struct isi_board * card = port->card;
unsigned long flags;
if (isicom_paranoia_check(port, tty->device, "isicom_unthrottle"))
return;
/* tell the card that this port is ready to accept more data */
save_flags(flags); cli();
card->port_status |= (1 << port->channel);
outw(card->port_status, card->base + 0x02);
restore_flags(flags);
}
/* stop et all */
static void isicom_stop(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
if (isicom_paranoia_check(port, tty->device, "isicom_stop"))
return;
/* this tells the transmitter not to consider this port for
data output to the card. */
port->status &= ~ISI_TXOK;
}
/* start et all */
static void isicom_start(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
if (isicom_paranoia_check(port, tty->device, "isicom_start"))
return;
/* this tells the transmitter to consider this port for
data output to the card. */
port->status |= ISI_TXOK;
}
/* hangup et all */
static void do_isicom_hangup(void * data)
{
struct isi_port * port = (struct isi_port *) data;
struct tty_struct * tty;
tty = port->tty;
if (tty)
tty_hangup(tty); /* FIXME: module removal race here - AKPM */
MOD_DEC_USE_COUNT;
}
static void isicom_hangup(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
if (isicom_paranoia_check(port, tty->device, "isicom_hangup"))
return;
isicom_shutdown_port(port);
port->count = 0;
port->flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CALLOUT_ACTIVE);
port->tty = 0;
wake_up_interruptible(&port->open_wait);
}
/* flush_buffer et all */
static void isicom_flush_buffer(struct tty_struct * tty)
{
struct isi_port * port = (struct isi_port *) tty->driver_data;
unsigned long flags;
if (isicom_paranoia_check(port, tty->device, "isicom_flush_buffer"))
return;
save_flags(flags); cli();
port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
restore_flags(flags);
wake_up_interruptible(&tty->write_wait);
if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
tty->ldisc.write_wakeup)
(tty->ldisc.write_wakeup)(tty);
}
static int register_ioregion(void)
{
int count, done=0;
for (count=0; count < BOARD_COUNT; count++ ) {
if (isi_card[count].base) {
if (check_region(isi_card[count].base,16)) {
printk(KERN_DEBUG "ISICOM: I/O Region 0x%x-0x%x is busy. Card%d will be disabled.\n",
isi_card[count].base,isi_card[count].base+15,count+1);
isi_card[count].base=0;
}
else {
request_region(isi_card[count].base,16,ISICOM_NAME);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: I/O Region 0x%x-0x%x requested for Card%d.\n",isi_card[count].base,isi_card[count].base+15,count+1);
#endif
done++;
}
}
}
return done;
}
static void unregister_ioregion(void)
{
int count;
for (count=0; count < BOARD_COUNT; count++ )
if (isi_card[count].base) {
release_region(isi_card[count].base,16);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: I/O Region 0x%x-0x%x released for Card%d.\n",isi_card[count].base,isi_card[count].base+15,count+1);
#endif
}
}
static int register_drivers(void)
{
int error;
/* tty driver structure initialization */
memset(&isicom_normal, 0, sizeof(struct tty_driver));
isicom_normal.magic = TTY_DRIVER_MAGIC;
isicom_normal.name = "ttyM";
isicom_normal.major = ISICOM_NMAJOR;
isicom_normal.minor_start = 0;
isicom_normal.num = PORT_COUNT;
isicom_normal.type = TTY_DRIVER_TYPE_SERIAL;
isicom_normal.subtype = SERIAL_TYPE_NORMAL;
isicom_normal.init_termios = tty_std_termios;
isicom_normal.init_termios.c_cflag =
B9600 | CS8 | CREAD | HUPCL |CLOCAL;
isicom_normal.flags = TTY_DRIVER_REAL_RAW;
isicom_normal.refcount = &isicom_refcount;
isicom_normal.table = isicom_table;
isicom_normal.termios = isicom_termios;
isicom_normal.termios_locked = isicom_termios_locked;
isicom_normal.open = isicom_open;
isicom_normal.close = isicom_close;
isicom_normal.write = isicom_write;
isicom_normal.put_char = isicom_put_char;
isicom_normal.flush_chars = isicom_flush_chars;
isicom_normal.write_room = isicom_write_room;
isicom_normal.chars_in_buffer = isicom_chars_in_buffer;
isicom_normal.ioctl = isicom_ioctl;
isicom_normal.set_termios = isicom_set_termios;
isicom_normal.throttle = isicom_throttle;
isicom_normal.unthrottle = isicom_unthrottle;
isicom_normal.stop = isicom_stop;
isicom_normal.start = isicom_start;
isicom_normal.hangup = isicom_hangup;
isicom_normal.flush_buffer = isicom_flush_buffer;
/* callout device */
isicom_callout = isicom_normal;
isicom_callout.name = "cum";
isicom_callout.major = ISICOM_CMAJOR;
isicom_callout.subtype = SERIAL_TYPE_CALLOUT;
if ((error=tty_register_driver(&isicom_normal))!=0) {
printk(KERN_DEBUG "ISICOM: Couldn't register the dialin driver, error=%d\n",
error);
return error;
}
if ((error=tty_register_driver(&isicom_callout))!=0) {
tty_unregister_driver(&isicom_normal);
printk(KERN_DEBUG "ISICOM: Couldn't register the callout driver, error=%d\n",
error);
return error;
}
return 0;
}
static void unregister_drivers(void)
{
int error;
if ((error=tty_unregister_driver(&isicom_callout))!=0)
printk(KERN_DEBUG "ISICOM: couldn't unregister callout driver error=%d.\n",error);
if (tty_unregister_driver(&isicom_normal))
printk(KERN_DEBUG "ISICOM: couldn't unregister normal driver error=%d.\n",error);
}
static int register_isr(void)
{
int count, done=0, card;
int flag;
unsigned char request;
for (count=0; count < BOARD_COUNT; count++ ) {
if (isi_card[count].base) {
/*
* verify if the required irq has already been requested for
* another ISI Card, if so we already have it, else request it
*/
request = YES;
for(card = 0; card < count; card++)
if ((isi_card[card].base) && (isi_card[card].irq == isi_card[count].irq)) {
request = NO;
if ((isi_card[count].isa == NO) && (isi_card[card].isa == NO))
break;
/*
* ISA cards cannot share interrupts with other
* PCI or ISA devices hence disable this card.
*/
release_region(isi_card[count].base,16);
isi_card[count].base = 0;
break;
}
flag=0;
if(isi_card[count].isa == NO)
flag |= SA_SHIRQ;
if (request == YES) {
if (request_irq(isi_card[count].irq, isicom_interrupt, SA_INTERRUPT|flag, ISICOM_NAME, NULL)) {
printk(KERN_WARNING "ISICOM: Could not install handler at Irq %d. Card%d will be disabled.\n",
isi_card[count].irq, count+1);
release_region(isi_card[count].base,16);
isi_card[count].base=0;
}
else {
printk(KERN_INFO "ISICOM: Card%d at 0x%x using irq %d.\n",
count+1, isi_card[count].base, isi_card[count].irq);
irq_to_board[isi_card[count].irq]=&isi_card[count];
done++;
}
}
}
}
return done;
}
static void unregister_isr(void)
{
int count, card;
unsigned char freeirq;
for (count=0; count < BOARD_COUNT; count++ ) {
if (isi_card[count].base) {
freeirq = YES;
for(card = 0; card < count; card++)
if ((isi_card[card].base) && (isi_card[card].irq == isi_card[count].irq)) {
freeirq = NO;
break;
}
if (freeirq == YES) {
free_irq(isi_card[count].irq, NULL);
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: Irq %d released for Card%d.\n",isi_card[count].irq, count+1);
#endif
}
}
}
}
static int isicom_init(void)
{
int card, channel, base;
struct isi_port * port;
unsigned long page;
if (!tmp_buf) {
page = get_free_page(GFP_KERNEL);
if (!page) {
#ifdef ISICOM_DEBUG
printk(KERN_DEBUG "ISICOM: Couldn't allocate page for tmp_buf.\n");
#else
printk(KERN_ERR "ISICOM: Not enough memory...\n");
#endif
return 0;
}
tmp_buf = (unsigned char *) page;
}
if (!register_ioregion())
{
printk(KERN_ERR "ISICOM: All required I/O space found busy.\n");
free_page((unsigned long)tmp_buf);
return 0;
}
if (register_drivers())
{
unregister_ioregion();
free_page((unsigned long)tmp_buf);
return 0;
}
if (!register_isr())
{
unregister_drivers();
/* ioports already uregistered in register_isr */
free_page((unsigned long)tmp_buf);
return 0;
}
/* initialize bottom half */
init_bh(ISICOM_BH, do_isicom_bh);
memset(isi_ports, 0, sizeof(isi_ports));
for (card = 0; card < BOARD_COUNT; card++) {
port = &isi_ports[card * 16];
isi_card[card].ports = port;
base = isi_card[card].base;
for (channel = 0; channel < 16; channel++, port++) {
port->magic = ISICOM_MAGIC;
port->card = &isi_card[card];
port->channel = channel;
port->normal_termios = isicom_normal.init_termios;
port->callout_termios = isicom_callout.init_termios;
port->close_delay = 50 * HZ/100;
port->closing_wait = 3000 * HZ/100;
port->hangup_tq.routine = do_isicom_hangup;
port->hangup_tq.data = port;
port->bh_tqueue.routine = isicom_bottomhalf;
port->bh_tqueue.data = port;
port->status = 0;
init_waitqueue_head(&port->open_wait);
init_waitqueue_head(&port->close_wait);
/* . . . */
}
}
return 1;
}
/*
* Insmod can set static symbols so keep these static
*/
static int io[4];
static int irq[4];
MODULE_AUTHOR("MultiTech");
MODULE_DESCRIPTION("Driver for the ISI series of cards by MultiTech");
MODULE_LICENSE("GPL");
MODULE_PARM(io, "1-4i");
MODULE_PARM_DESC(io, "I/O ports for the cards");
MODULE_PARM(irq, "1-4i");
MODULE_PARM_DESC(irq, "Interrupts for the cards");
int init_module(void)
{
struct pci_dev *dev = NULL;
int retval, card, idx, count;
unsigned char pciirq;
unsigned int ioaddr;
card = 0;
for(idx=0; idx < BOARD_COUNT; idx++) {
if (io[idx]) {
isi_card[idx].base=io[idx];
isi_card[idx].irq=irq[idx];
isi_card[idx].isa=YES;
card++;
}
else {
isi_card[idx].base = 0;
isi_card[idx].irq = 0;
}
}
for (idx=0 ;idx < card; idx++) {
if (!((isi_card[idx].irq==2)||(isi_card[idx].irq==3)||
(isi_card[idx].irq==4)||(isi_card[idx].irq==5)||
(isi_card[idx].irq==7)||(isi_card[idx].irq==10)||
(isi_card[idx].irq==11)||(isi_card[idx].irq==12)||
(isi_card[idx].irq==15))) {
if (isi_card[idx].base) {
printk(KERN_ERR "ISICOM: Irq %d unsupported. Disabling Card%d...\n",
isi_card[idx].irq, idx+1);
isi_card[idx].base=0;
card--;
}
}
}
if (pci_present() && (card < BOARD_COUNT)) {
for (idx=0; idx < DEVID_COUNT; idx++) {
dev = NULL;
for (;;){
if (!(dev = pci_find_device(VENDOR_ID, isicom_pci_tbl[idx].device, dev)))
break;
if (card >= BOARD_COUNT)
break;
if (pci_enable_device(dev))
break;
/* found a PCI ISI card! */
ioaddr = pci_resource_start (dev, 3); /* i.e at offset 0x1c in the
* PCI configuration register
* space.
*/
pciirq = dev->irq;
printk(KERN_INFO "ISI PCI Card(Device ID 0x%x)\n", isicom_pci_tbl[idx].device);
/*
* allot the first empty slot in the array
*/
for (count=0; count < BOARD_COUNT; count++) {
if (isi_card[count].base == 0) {
isi_card[count].base = ioaddr;
isi_card[count].irq = pciirq;
isi_card[count].isa = NO;
card++;
break;
}
}
}
if (card >= BOARD_COUNT) break;
}
}
if (!(isi_card[0].base || isi_card[1].base || isi_card[2].base || isi_card[3].base)) {
printk(KERN_ERR "ISICOM: No valid card configuration. Driver cannot be initialized...\n");
return -EIO;
}
retval=misc_register(&isiloader_device);
if (retval<0) {
printk(KERN_ERR "ISICOM: Unable to register firmware loader driver.\n");
return -EIO;
}
if (!isicom_init()) {
if (misc_deregister(&isiloader_device))
printk(KERN_ERR "ISICOM: Unable to unregister Firmware Loader driver\n");
return -EIO;
}
init_timer(&tx);
tx.expires = jiffies + 1;
tx.data = 0;
tx.function = isicom_tx;
re_schedule = 1;
add_timer(&tx);
return 0;
}
void cleanup_module(void)
{
re_schedule = 0;
set_current_state(TASK_INTERRUPTIBLE);
schedule_timeout(HZ);
remove_bh(ISICOM_BH);
#ifdef ISICOM_DEBUG
printk("ISICOM: isicom_tx tx_count = %ld.\n", tx_count);
#endif
#ifdef ISICOM_DEBUG
printk("ISICOM: uregistering isr ...\n");
#endif
unregister_isr();
#ifdef ISICOM_DEBUG
printk("ISICOM: unregistering drivers ...\n");
#endif
unregister_drivers();
#ifdef ISICOM_DEBUG
printk("ISICOM: unregistering ioregion ...\n");
#endif
unregister_ioregion();
#ifdef ISICOM_DEBUG
printk("ISICOM: freeing tmp_buf ...\n");
#endif
free_page((unsigned long)tmp_buf);
#ifdef ISICOM_DEBUG
printk("ISICOM: unregistering firmware loader ...\n");
#endif
if (misc_deregister(&isiloader_device))
printk(KERN_ERR "ISICOM: Unable to unregister Firmware Loader driver\n");
}
|