URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [trunk/] [rc203soc/] [sw/] [uClinux/] [drivers/] [char/] [isicom.c] - Rev 1777
Go to most recent revision | Compare with Previous | Blame | View Log
/* * 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 */ /* * Currently ISICOM_BH is hard coded to 16 in isicom.h, cannot * ask the kernel for a free slot as of 2.0.x - sameer */ #include <linux/config.h> #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/system.h> #include <asm/io.h> #include <linux/isicom.h> static int isicom_refcount = 0; static int prev_card = 3; /* start servicing isi_card[0] */ static struct isi_board * irq_to_board[16] = { NULL, }; static struct tty_driver isicom_normal, isicom_callout; static struct tty_struct * isicom_table[PORT_COUNT] = { NULL, }; static struct termios * isicom_termios[PORT_COUNT] = { NULL, }; static struct termios * isicom_termios_locked[PORT_COUNT] = { NULL, }; 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 unsigned long tx_count = 0; #endif static int ISILoad_open(struct inode *inode, struct file *filp); static void ISILoad_release(struct inode *inode, struct file *filp); 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 struct semaphore tmp_buf_sem = MUTEX; /* baud index mappings from linux defns to isi */ static 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 = { NULL, /* lseek */ NULL, /* read */ NULL, /* write */ NULL, /* readdir */ NULL, /* select */ ISILoad_ioctl, NULL, /* mmap */ ISILoad_open, ISILoad_release, NULL, /* fsync */ NULL, /* fasync */ NULL, /* check_media_change */ NULL, /* revalidate */ }; 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_open(struct inode *inode, struct file *filp) { #ifdef ISICOM_DEBUG printk(KERN_DEBUG "ISILoad:Firmware loader Opened!!!\n"); #endif MOD_INC_USE_COUNT; return 0; } static void ISILoad_release(struct inode *inode, struct file *filp) { #ifdef ISICOM_DEBUG printk(KERN_DEBUG "ISILoad:Firmware loader Close(Release)d\n",); #endif MOD_DEC_USE_COUNT; } static int ISILoad_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg) { unsigned int card, i, j, signature, status; unsigned short error, word_count, base; bin_frame frame; /* exec_record exec_rec; */ /* Added this check to avoid oopses on an ioctl with no * args - sameer */ error=verify_area(VERIFY_READ, (void *) arg, sizeof(int)); if (error) return error; card=get_user((int *)arg); 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 (!suser()) return -EPERM; error=verify_area(VERIFY_WRITE, (void *) arg, sizeof(int)); if (error) return error; printk(KERN_DEBUG "ISILoad:Resetting Card%d at 0x%x ",card+1,base); inw(base+0x8); for(i=jiffies+HZ/100;i>jiffies;); outw(0,base+0x8); /* Reset */ for(j=1;j<=3;j++) { for(i=jiffies+HZ;i>jiffies;); printk("."); } signature=(inw(base+0x4)) & 0xff; 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: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: 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"); put_user(signature,(unsigned int*)arg); return 0; case MIOCTL_LOAD_FIRMWARE: if (!suser()) return -EPERM; error=verify_area(VERIFY_READ, (void *) arg, sizeof(bin_frame)); if (error) return error; memcpy_fromfs(&frame, (void *) arg, sizeof(bin_frame)); 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 (!suser()) return -EPERM; error=verify_area(VERIFY_READ, (void *) arg, sizeof(bin_header)); if (error) return error; memcpy_fromfs(&frame, (void *) arg, sizeof(bin_header)); 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; } error=verify_area(VERIFY_WRITE, (void *) arg, sizeof(bin_frame)); if (error) return error; memcpy_tofs((void *) arg, &frame, sizeof(bin_frame)); return 0; case MIOCTL_XFER_CTRL: if (!suser()) return -EPERM; if (WaitTillCardIsFree(base)) return -EIO; outw(0xf2, base); outw(0x800, base); outw(0x0, base); outw(0x0, base); InterruptTheCard(base); 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_irq_off(&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--; } } /* * Replaced the code below with hopefully a faster loop - sameer */ /* while (1) { wrd = port->xmit_buf[port->xmit_tail++]; port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE - 1); port->xmit_cnt--; if (--txcount > 0) { wrd |= (port->xmit_buf[port->xmit_tail++] << 8); port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE - 1); port->xmit_cnt--; outw(wrd, base); if (--txcount <= 0) break; } else { outw(wrd, base); break; } } */ 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; card = irq_to_board[irq]; if (!card || !(card->status & FIRMWARE_LOADED)) { printk(KERN_DEBUG "ISICOM: interrupt: not handling irq%d!.\n", irq); return; } base = card->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); ClearInterrupt(base); return; } port = card->ports + channel; if (!(port->flags & ASYNC_INITIALIZED)) { ClearInterrupt(base); 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))) queue_task_irq_off(&port->hangup_tq, &tq_scheduler); } } 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_irq_off(&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_irq_off(&tty->flip.tqueue, &tq_timer); } ClearInterrupt(base); 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; struct wait_queue wait = { current, NULL }; /* 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(); 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 (current->signal & ~current->blocked) { #ifdef ISICOM_DEBUG printk(KERN_DEBUG "ISICOM: block_til_ready: sig blocked.\n"); #endif 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; 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 higher 8 dev files on a 8 port card !!! */ if (card->port_count == 8) if (line > ((board * 16)+7)) { printk(KERN_ERR "ISICOM: Opened >8 on a 8 port 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) { current->state = TASK_INTERRUPTIBLE; current->timeout = jiffies + port->close_delay; #ifdef ISICOM_DEBUG printk(KERN_DEBUG "ISICOM: scheduling until time out.\n"); #endif schedule(); } 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(); */ memcpy_fromfs(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"); return; } outw(0x8000 | ((port->channel) << (card->shift_count)) | 0x3, base); outw((length & 0xff) << 8 | 0x00, base); outw((length & 0xff00), base); InterruptTheCard(base); 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); put_user(info, (unsigned long *) value); return 0; } static int isicom_set_modem_info(struct isi_port * port, unsigned int cmd, unsigned int * value) { unsigned int arg; unsigned long flags; arg = get_user(value); 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; memcpy_fromfs(&newinfo, info, sizeof(newinfo)); reconfig_port = ((port->flags & ASYNC_SPD_MASK) != (newinfo.flags & ASYNC_SPD_MASK)); if (!suser()) { 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; memcpy_tofs(info, &out_info, sizeof(out_info)); 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, error; 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: error = verify_area(VERIFY_WRITE, (void *) arg, sizeof(long)); if (error) return error; put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned long *) arg); return 0; case TIOCSSOFTCAR: error = verify_area(VERIFY_READ, (void *) arg, sizeof(long)); if (error) return error; arg = get_user((unsigned long *) arg); tty->termios->c_cflag = ((tty->termios->c_cflag & ~CLOCAL) | (arg ? CLOCAL : 0)); return 0; case TIOCMGET: error = verify_area(VERIFY_WRITE, (void *) arg, sizeof(unsigned int)); if (error) return error; return isicom_get_modem_info(port, (unsigned int*) arg); case TIOCMBIS: case TIOCMBIC: case TIOCMSET: error = verify_area(VERIFY_READ, (void *) arg, sizeof(unsigned int)); if (error) return error; return isicom_set_modem_info(port, cmd, (unsigned int *) arg); case TIOCGSERIAL: error = verify_area(VERIFY_WRITE, (void *) arg, sizeof(struct serial_struct)); if (error) return error; return isicom_get_serial_info(port, (struct serial_struct *) arg); case TIOCSSERIAL: error = verify_area(VERIFY_READ, (void *) arg, sizeof(struct serial_struct)); if (error) return error; 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) return; tty_hangup(tty); } 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; for (count=0; count < BOARD_COUNT; count++ ) { if (isi_card[count].base) { if (request_irq(isi_card[count].irq, isicom_interrupt, SA_INTERRUPT, 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; for (count=0; count < BOARD_COUNT; count++ ) if (isi_card[count].base) { 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; /* . . . */ } } return 1; } /* * Insmod can set static symbols so keep these static */ static int ISIBase1=0, ISIBase2=0, ISIBase3=0, ISIBase4=0; static int Irq1=0, Irq2=0, Irq3=0, Irq4=0; int init_module(void) { int retval, card; isi_card[0].base=ISIBase1; isi_card[1].base=ISIBase2; isi_card[2].base=ISIBase3; isi_card[3].base=ISIBase4; isi_card[0].irq=Irq1; isi_card[1].irq=Irq2; isi_card[2].irq=Irq3; isi_card[3].irq=Irq4; for (card=0 ;card < BOARD_COUNT; card++) { if (!((isi_card[card].irq==2)||(isi_card[card].irq==3)|| (isi_card[card].irq==4)||(isi_card[card].irq==5)|| (isi_card[card].irq==7)||(isi_card[card].irq==10)|| (isi_card[card].irq==11)||(isi_card[card].irq==12)|| (isi_card[card].irq==15))) { if (isi_card[card].base) { printk(KERN_ERR "ISICOM: Irq %d unsupported. Disabling Card%d...\n", isi_card[card].irq, card+1); isi_card[card].base=0; } } } 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; current->state = TASK_INTERRUPTIBLE; current->timeout = jiffies + HZ; schedule(); disable_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"); }
Go to most recent revision | Compare with Previous | Blame | View Log