嵌入式Linux

开发平台：

Unix_Linux

cyclades.c：源码内容

if (info->blocked_open) {
CY_UNLOCK(info, flags);
if (info->close_delay) {
current->state = TASK_INTERRUPTIBLE;
schedule_timeout(info->close_delay);
}
wake_up_interruptible(&info->open_wait);
CY_LOCK(info, flags);
}
info->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CALLOUT_ACTIVE|
ASYNC_CLOSING);
wake_up_interruptible(&info->close_wait);
#ifdef CY_DEBUG_OTHER
printk(" cyc:cy_close donen");
#endif
MOD_DEC_USE_COUNT;
CY_UNLOCK(info, flags);
return;
} /* cy_close */
/* This routine gets called when tty_write has put something into
* the write_queue. The characters may come from user space or
* kernel space.
*
* This routine will return the number of characters actually
* accepted for writing.
*
* If the port is not already transmitting stuff, start it off by
* enabling interrupts. The interrupt service routine will then
* ensure that the characters are sent.
* If the port is already active, there is no need to kick it.
*
*/
static int
cy_write(struct tty_struct * tty, int from_user,
const unsigned char *buf, int count)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned long flags;
int c, ret = 0;
#ifdef CY_DEBUG_IO
printk("cyc:cy_write ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_write")){
return 0;
}
if (!tty || !info->xmit_buf || !tmp_buf){
return 0;
}
if (from_user) {
down(&tmp_buf_sem);
while (1) {
int c1;
c = MIN(count, MIN(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
SERIAL_XMIT_SIZE - info->xmit_head));
if (c <= 0)
break;
c -= copy_from_user(tmp_buf, buf, c);
if (!c) {
if (!ret) {
ret = -EFAULT;
}
break;
}
CY_LOCK(info, flags);
c1 = MIN(c, MIN(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
SERIAL_XMIT_SIZE - info->xmit_head));
if (c1 < c)
c = c1;
memcpy(info->xmit_buf + info->xmit_head, tmp_buf, c);
info->xmit_head = ((info->xmit_head + c) & (SERIAL_XMIT_SIZE-1));
info->xmit_cnt += c;
CY_UNLOCK(info, flags);
buf += c;
count -= c;
ret += c;
}
up(&tmp_buf_sem);
} else {
CY_LOCK(info, flags);
while (1) {
c = MIN(count, MIN(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
SERIAL_XMIT_SIZE - info->xmit_head));
if (c <= 0)
break;
memcpy(info->xmit_buf + info->xmit_head, buf, c);
info->xmit_head = (info->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
info->xmit_cnt += c;
buf += c;
count -= c;
ret += c;
}
CY_UNLOCK(info, flags);
}
info->idle_stats.xmit_bytes += ret;
info->idle_stats.xmit_idle = jiffies;
if (info->xmit_cnt && !tty->stopped && !tty->hw_stopped) {
start_xmit(info);
}
return ret;
} /* cy_write */
/*
* This routine is called by the kernel to write a single
* character to the tty device. If the kernel uses this routine,
* it must call the flush_chars() routine (if defined) when it is
* done stuffing characters into the driver. If there is no room
* in the queue, the character is ignored.
*/
static void
cy_put_char(struct tty_struct *tty, unsigned char ch)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned long flags;
#ifdef CY_DEBUG_IO
printk("cyc:cy_put_char ttyC%dn", info->line);
#endif
if (serial_paranoia_check(info, tty->device, "cy_put_char"))
return;
if (!tty || !info->xmit_buf)
return;
CY_LOCK(info, flags);
if (info->xmit_cnt >= SERIAL_XMIT_SIZE - 1) {
CY_UNLOCK(info, flags);
return;
}
info->xmit_buf[info->xmit_head++] = ch;
info->xmit_head &= SERIAL_XMIT_SIZE - 1;
info->xmit_cnt++;
info->idle_stats.xmit_bytes++;
info->idle_stats.xmit_idle = jiffies;
CY_UNLOCK(info, flags);
} /* cy_put_char */
/*
* This routine is called by the kernel after it has written a
* series of characters to the tty device using put_char().
*/
static void
cy_flush_chars(struct tty_struct *tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
#ifdef CY_DEBUG_IO
printk("cyc:cy_flush_chars ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_flush_chars"))
return;
if (info->xmit_cnt <= 0 || tty->stopped
|| tty->hw_stopped || !info->xmit_buf)
return;
start_xmit(info);
} /* cy_flush_chars */
/*
* This routine returns the numbers of characters the tty driver
* will accept for queuing to be written. This number is subject
* to change as output buffers get emptied, or if the output flow
* control is activated.
*/
static int
cy_write_room(struct tty_struct *tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
int ret;
#ifdef CY_DEBUG_IO
printk("cyc:cy_write_room ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_write_room"))
return 0;
ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
if (ret < 0)
ret = 0;
return ret;
} /* cy_write_room */
static int
cy_chars_in_buffer(struct tty_struct *tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
int card, channel;
if (serial_paranoia_check(info, tty->device, "cy_chars_in_buffer"))
return 0;
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
#ifdef Z_EXT_CHARS_IN_BUFFER
if (!IS_CYC_Z(cy_card[card])) {
#endif /* Z_EXT_CHARS_IN_BUFFER */
#ifdef CY_DEBUG_IO
printk("cyc:cy_chars_in_buffer ttyC%d %dn",
info->line, info->xmit_cnt); /* */
#endif
return info->xmit_cnt;
#ifdef Z_EXT_CHARS_IN_BUFFER
} else {
static volatile struct FIRM_ID *firm_id;
static volatile struct ZFW_CTRL *zfw_ctrl;
static volatile struct CH_CTRL *ch_ctrl;
static volatile struct BUF_CTRL *buf_ctrl;
int char_count;
volatile uclong tx_put, tx_get, tx_bufsize;
firm_id = (struct FIRM_ID *)(cy_card[card].base_addr + ID_ADDRESS);
zfw_ctrl = (struct ZFW_CTRL *)
(cy_card[card].base_addr +
(cy_readl(&firm_id->zfwctrl_addr) & 0xfffff));
ch_ctrl = &(zfw_ctrl->ch_ctrl[channel]);
buf_ctrl = &(zfw_ctrl->buf_ctrl[channel]);
tx_get = cy_readl(&buf_ctrl->tx_get);
tx_put = cy_readl(&buf_ctrl->tx_put);
tx_bufsize = cy_readl(&buf_ctrl->tx_bufsize);
if (tx_put >= tx_get)
char_count = tx_put - tx_get;
else
char_count = tx_put - tx_get + tx_bufsize;
#ifdef CY_DEBUG_IO
printk("cyc:cy_chars_in_buffer ttyC%d %dn",
info->line, info->xmit_cnt + char_count); /* */
#endif
return (info->xmit_cnt + char_count);
}
#endif /* Z_EXT_CHARS_IN_BUFFER */
} /* cy_chars_in_buffer */
/*
* ------------------------------------------------------------
* cy_ioctl() and friends
* ------------------------------------------------------------
*/
static void
cyy_baud_calc(struct cyclades_port *info, uclong baud)
{
int co, co_val, bpr;
uclong cy_clock = ((info->chip_rev >= CD1400_REV_J) ? 60000000 : 25000000);
if (baud == 0) {
info->tbpr = info->tco = info->rbpr = info->rco = 0;
return;
}
/* determine which prescaler to use */
for (co = 4, co_val = 2048; co; co--, co_val >>= 2) {
if (cy_clock / co_val / baud > 63)
break;
}
bpr = (cy_clock / co_val * 2 / baud + 1) / 2;
if (bpr > 255)
bpr = 255;
info->tbpr = info->rbpr = bpr;
info->tco = info->rco = co;
}
/*
* This routine finds or computes the various line characteristics.
* It used to be called config_setup
*/
static void
set_line_char(struct cyclades_port * info)
{
unsigned long flags;
unsigned char *base_addr;
int card,chip,channel,index;
unsigned cflag, iflag;
unsigned short chip_number;
int baud, baud_rate = 0;
int i;
if (!info->tty || !info->tty->termios){
return;
}
if (info->line == -1){
return;
}
cflag = info->tty->termios->c_cflag;
iflag = info->tty->termios->c_iflag;
/*
* Set up the tty->alt_speed kludge
*/
if (info->tty) {
if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
info->tty->alt_speed = 57600;
if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
info->tty->alt_speed = 115200;
if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
info->tty->alt_speed = 230400;
if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
info->tty->alt_speed = 460800;
}
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
chip_number = channel / 4;
if (!IS_CYC_Z(cy_card[card])) {
index = cy_card[card].bus_index;
/* baud rate */
baud = tty_get_baud_rate(info->tty);
if ((baud == 38400) &&
((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)) {
if (info->custom_divisor)
baud_rate = info->baud / info->custom_divisor;
else
baud_rate = info->baud;
} else if (baud > CD1400_MAX_SPEED) {
baud = CD1400_MAX_SPEED;
}
/* find the baud index */
for (i = 0; i < 20; i++) {
if (baud == baud_table[i]) {
break;
}
}
if (i == 20) {
i = 19; /* CD1400_MAX_SPEED */
}
if ((baud == 38400) &&
((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)) {
cyy_baud_calc(info, baud_rate);
} else {
if(info->chip_rev >= CD1400_REV_J) {
/* It is a CD1400 rev. J or later */
info->tbpr = baud_bpr_60[i]; /* Tx BPR */
info->tco = baud_co_60[i]; /* Tx CO */
info->rbpr = baud_bpr_60[i]; /* Rx BPR */
info->rco = baud_co_60[i]; /* Rx CO */
} else {
info->tbpr = baud_bpr_25[i]; /* Tx BPR */
info->tco = baud_co_25[i]; /* Tx CO */
info->rbpr = baud_bpr_25[i]; /* Rx BPR */
info->rco = baud_co_25[i]; /* Rx CO */
}
}
if (baud_table[i] == 134) {
/* get it right for 134.5 baud */
info->timeout = (info->xmit_fifo_size*HZ*30/269) + 2;
} else if ((baud == 38400) &&
((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)) {
info->timeout = (info->xmit_fifo_size*HZ*15/baud_rate) + 2;
} else if (baud_table[i]) {
info->timeout = (info->xmit_fifo_size*HZ*15/baud_table[i]) + 2;
/* this needs to be propagated into the card info */
} else {
info->timeout = 0;
}
/* By tradition (is it a standard?) a baud rate of zero
implies the line should be/has been closed. A bit
later in this routine such a test is performed. */
/* byte size and parity */
info->cor5 = 0;
info->cor4 = 0;
info->cor3 = (info->default_threshold
? info->default_threshold
: baud_cor3[i]); /* receive threshold */
info->cor2 = CyETC;
switch(cflag & CSIZE){
case CS5:
info->cor1 = Cy_5_BITS;
break;
case CS6:
info->cor1 = Cy_6_BITS;
break;
case CS7:
info->cor1 = Cy_7_BITS;
break;
case CS8:
info->cor1 = Cy_8_BITS;
break;
}
if(cflag & CSTOPB){
info->cor1 |= Cy_2_STOP;
}
if (cflag & PARENB){
if (cflag & PARODD){
info->cor1 |= CyPARITY_O;
}else{
info->cor1 |= CyPARITY_E;
}
}else{
info->cor1 |= CyPARITY_NONE;
}
/* CTS flow control flag */
if (cflag & CRTSCTS){
info->flags |= ASYNC_CTS_FLOW;
info->cor2 |= CyCtsAE;
}else{
info->flags &= ~ASYNC_CTS_FLOW;
info->cor2 &= ~CyCtsAE;
}
if (cflag & CLOCAL)
info->flags &= ~ASYNC_CHECK_CD;
else
info->flags |= ASYNC_CHECK_CD;
/***********************************************
The hardware option, CyRtsAO, presents RTS when
the chip has characters to send. Since most modems
use RTS as reverse (inbound) flow control, this
option is not used. If inbound flow control is
necessary, DTR can be programmed to provide the
appropriate signals for use with a non-standard
cable. Contact Marcio Saito for details.
***********************************************/
chip = channel>>2;
channel &= 0x03;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
/* tx and rx baud rate */
cy_writeb((u_long)base_addr+(CyTCOR<<index), info->tco);
cy_writeb((u_long)base_addr+(CyTBPR<<index), info->tbpr);
cy_writeb((u_long)base_addr+(CyRCOR<<index), info->rco);
cy_writeb((u_long)base_addr+(CyRBPR<<index), info->rbpr);
/* set line characteristics according configuration */
cy_writeb((u_long)base_addr+(CySCHR1<<index),
START_CHAR(info->tty));
cy_writeb((u_long)base_addr+(CySCHR2<<index),
STOP_CHAR(info->tty));
cy_writeb((u_long)base_addr+(CyCOR1<<index), info->cor1);
cy_writeb((u_long)base_addr+(CyCOR2<<index), info->cor2);
cy_writeb((u_long)base_addr+(CyCOR3<<index), info->cor3);
cy_writeb((u_long)base_addr+(CyCOR4<<index), info->cor4);
cy_writeb((u_long)base_addr+(CyCOR5<<index), info->cor5);
cyy_issue_cmd(base_addr,
CyCOR_CHANGE|CyCOR1ch|CyCOR2ch|CyCOR3ch,index);
cy_writeb((u_long)base_addr+(CyCAR<<index),
(u_char)channel); /* !!! Is this needed? */
cy_writeb((u_long)base_addr+(CyRTPR<<index), (info->default_timeout
? info->default_timeout
: 0x02)); /* 10ms rx timeout */
if (C_CLOCAL(info->tty)) {
/* without modem intr */
cy_writeb((u_long)base_addr+(CySRER<<index),
cy_readb(base_addr+(CySRER<<index)) | CyMdmCh);
/* act on 1->0 modem transitions */
if ((cflag & CRTSCTS) && info->rflow) {
cy_writeb((u_long)base_addr+(CyMCOR1<<index),
(CyCTS|rflow_thr[i]));
} else {
cy_writeb((u_long)base_addr+(CyMCOR1<<index), CyCTS);
}
/* act on 0->1 modem transitions */
cy_writeb((u_long)base_addr+(CyMCOR2<<index), CyCTS);
} else {
/* without modem intr */
cy_writeb((u_long)base_addr+(CySRER<<index),
cy_readb(base_addr+(CySRER<<index)) | CyMdmCh);
/* act on 1->0 modem transitions */
if ((cflag & CRTSCTS) && info->rflow) {
cy_writeb((u_long)base_addr+(CyMCOR1<<index),
(CyDSR|CyCTS|CyRI|CyDCD|rflow_thr[i]));
} else {
cy_writeb((u_long)base_addr+(CyMCOR1<<index),
CyDSR|CyCTS|CyRI|CyDCD);
}
/* act on 0->1 modem transitions */
cy_writeb((u_long)base_addr+(CyMCOR2<<index),
CyDSR|CyCTS|CyRI|CyDCD);
}
if(i == 0){ /* baud rate is zero, turn off line */
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_line_char dropping DTRn");
printk(" status: 0x%x,
0x%xn", cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
}else{
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_line_char raising DTRn");
printk(" status: 0x%x, 0x%xn",
cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
}
if (info->tty){
clear_bit(TTY_IO_ERROR, &info->tty->flags);
}
CY_UNLOCK(info, flags);
} else {
struct FIRM_ID *firm_id;
struct ZFW_CTRL *zfw_ctrl;
struct BOARD_CTRL *board_ctrl;
struct CH_CTRL *ch_ctrl;
struct BUF_CTRL *buf_ctrl;
uclong sw_flow;
int retval;
firm_id = (struct FIRM_ID *)
(cy_card[card].base_addr + ID_ADDRESS);
if (!ISZLOADED(cy_card[card])) {
return;
}
zfw_ctrl = (struct ZFW_CTRL *)
(cy_card[card].base_addr +
(cy_readl(&firm_id->zfwctrl_addr) & 0xfffff));
board_ctrl = &zfw_ctrl->board_ctrl;
ch_ctrl = &(zfw_ctrl->ch_ctrl[channel]);
buf_ctrl = &zfw_ctrl->buf_ctrl[channel];
/* baud rate */
baud = tty_get_baud_rate(info->tty);
if ((baud == 38400) &&
((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)) {
if (info->custom_divisor)
baud_rate = info->baud / info->custom_divisor;
else
baud_rate = info->baud;
} else if (baud > CYZ_MAX_SPEED) {
baud = CYZ_MAX_SPEED;
}
cy_writel(&ch_ctrl->comm_baud , baud);
if (baud == 134) {
/* get it right for 134.5 baud */
info->timeout = (info->xmit_fifo_size*HZ*30/269) + 2;
} else if ((baud == 38400) &&
((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST)) {
info->timeout = (info->xmit_fifo_size*HZ*15/baud_rate) + 2;
} else if (baud) {
info->timeout = (info->xmit_fifo_size*HZ*15/baud) + 2;
/* this needs to be propagated into the card info */
} else {
info->timeout = 0;
}
/* byte size and parity */
switch(cflag & CSIZE){
case CS5: cy_writel(&ch_ctrl->comm_data_l , C_DL_CS5); break;
case CS6: cy_writel(&ch_ctrl->comm_data_l , C_DL_CS6); break;
case CS7: cy_writel(&ch_ctrl->comm_data_l , C_DL_CS7); break;
case CS8: cy_writel(&ch_ctrl->comm_data_l , C_DL_CS8); break;
}
if(cflag & CSTOPB){
cy_writel(&ch_ctrl->comm_data_l,
cy_readl(&ch_ctrl->comm_data_l) | C_DL_2STOP);
}else{
cy_writel(&ch_ctrl->comm_data_l,
cy_readl(&ch_ctrl->comm_data_l) | C_DL_1STOP);
}
if (cflag & PARENB){
if (cflag & PARODD){
cy_writel(&ch_ctrl->comm_parity , C_PR_ODD);
}else{
cy_writel(&ch_ctrl->comm_parity , C_PR_EVEN);
}
}else{
cy_writel(&ch_ctrl->comm_parity , C_PR_NONE);
}
/* CTS flow control flag */
if (cflag & CRTSCTS){
cy_writel(&ch_ctrl->hw_flow,
cy_readl(&ch_ctrl->hw_flow) | C_RS_CTS | C_RS_RTS);
}else{
cy_writel(&ch_ctrl->hw_flow,
cy_readl(&ch_ctrl->hw_flow) & ~(C_RS_CTS | C_RS_RTS));
}
/* As the HW flow control is done in firmware, the driver doesn't
need to care about it */
info->flags &= ~ASYNC_CTS_FLOW;
/* XON/XOFF/XANY flow control flags */
sw_flow = 0;
if (iflag & IXON){
sw_flow |= C_FL_OXX;
if (iflag & IXANY)
sw_flow |= C_FL_OIXANY;
}
cy_writel(&ch_ctrl->sw_flow, sw_flow);
retval = cyz_issue_cmd(&cy_card[card], channel, C_CM_IOCTL, 0L);
if (retval != 0){
printk("cyc:set_line_char retval on ttyC%d was %xn",
info->line, retval);
}
/* CD sensitivity */
if (cflag & CLOCAL){
info->flags &= ~ASYNC_CHECK_CD;
}else{
info->flags |= ASYNC_CHECK_CD;
}
if(baud == 0){ /* baud rate is zero, turn off line */
cy_writel(&ch_ctrl->rs_control,
cy_readl(&ch_ctrl->rs_control) & ~C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_line_char dropping Z DTRn");
#endif
}else{
cy_writel(&ch_ctrl->rs_control,
cy_readl(&ch_ctrl->rs_control) | C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_line_char raising Z DTRn");
#endif
}
retval = cyz_issue_cmd( &cy_card[card], channel, C_CM_IOCTLM, 0L);
if (retval != 0){
printk("cyc:set_line_char(2) retval on ttyC%d was %xn",
info->line, retval);
}
if (info->tty){
clear_bit(TTY_IO_ERROR, &info->tty->flags);
}
}
} /* set_line_char */
static int
get_serial_info(struct cyclades_port * info,
struct serial_struct * retinfo)
{
struct serial_struct tmp;
struct cyclades_card *cinfo = &cy_card[info->card];
if (!retinfo)
return -EFAULT;
memset(&tmp, 0, sizeof(tmp));
tmp.type = info->type;
tmp.line = info->line;
tmp.port = info->card * 0x100 + info->line - cinfo->first_line;
tmp.irq = cinfo->irq;
tmp.flags = info->flags;
tmp.close_delay = info->close_delay;
tmp.baud_base = info->baud;
tmp.custom_divisor = info->custom_divisor;
tmp.hub6 = 0; /*!!!*/
return copy_to_user(retinfo,&tmp,sizeof(*retinfo))?-EFAULT:0;
} /* get_serial_info */
static int
set_serial_info(struct cyclades_port * info,
struct serial_struct * new_info)
{
struct serial_struct new_serial;
struct cyclades_port old_info;
if (copy_from_user(&new_serial,new_info,sizeof(new_serial)))
return -EFAULT;
old_info = *info;
if (!capable(CAP_SYS_ADMIN)) {
if ((new_serial.close_delay != info->close_delay) ||
(new_serial.baud_base != info->baud) ||
((new_serial.flags & ASYNC_FLAGS & ~ASYNC_USR_MASK) !=
(info->flags & ASYNC_FLAGS & ~ASYNC_USR_MASK)))
return -EPERM;
info->flags = ((info->flags & ~ASYNC_USR_MASK) |
(new_serial.flags & ASYNC_USR_MASK));
info->baud = new_serial.baud_base;
info->custom_divisor = new_serial.custom_divisor;
goto check_and_exit;
}
/*
* OK, past this point, all the error checking has been done.
* At this point, we start making changes.....
*/
info->baud = new_serial.baud_base;
info->custom_divisor = new_serial.custom_divisor;
info->flags = ((info->flags & ~ASYNC_FLAGS) |
(new_serial.flags & ASYNC_FLAGS));
info->close_delay = new_serial.close_delay * HZ/100;
info->closing_wait = new_serial.closing_wait * HZ/100;
check_and_exit:
if (info->flags & ASYNC_INITIALIZED){
set_line_char(info);
return 0;
}else{
return startup(info);
}
} /* set_serial_info */
/*
* get_lsr_info - get line status register info
*
* Purpose: Let user call ioctl() to get info when the UART physically
* is emptied. On bus types like RS485, the transmitter must
* release the bus after transmitting. This must be done when
* the transmit shift register is empty, not be done when the
* transmit holding register is empty. This functionality
* allows an RS485 driver to be written in user space.
*/
static int get_lsr_info(struct cyclades_port *info, unsigned int *value)
{
int card, chip, channel, index;
unsigned char status;
unsigned int result;
unsigned long flags;
unsigned char *base_addr;
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char *)
(cy_card[card].base_addr + (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
status = cy_readb(base_addr+(CySRER<<index)) & (CyTxRdy|CyTxMpty);
CY_UNLOCK(info, flags);
result = (status ? 0 : TIOCSER_TEMT);
} else {
/* Not supported yet */
return -EINVAL;
}
return cy_put_user(result, (unsigned long *) value);
}
static int
get_modem_info(struct cyclades_port * info, unsigned int *value)
{
int card,chip,channel,index;
unsigned char *base_addr;
unsigned long flags;
unsigned char status;
unsigned long lstatus;
unsigned int result;
struct FIRM_ID *firm_id;
struct ZFW_CTRL *zfw_ctrl;
struct BOARD_CTRL *board_ctrl;
struct CH_CTRL *ch_ctrl;
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
status = cy_readb(base_addr+(CyMSVR1<<index));
status |= cy_readb(base_addr+(CyMSVR2<<index));
CY_UNLOCK(info, flags);
if (info->rtsdtr_inv) {
result = ((status & CyRTS) ? TIOCM_DTR : 0)
| ((status & CyDTR) ? TIOCM_RTS : 0);
} else {
result = ((status & CyRTS) ? TIOCM_RTS : 0)
| ((status & CyDTR) ? TIOCM_DTR : 0);
}
result |= ((status & CyDCD) ? TIOCM_CAR : 0)
| ((status & CyRI) ? TIOCM_RNG : 0)
| ((status & CyDSR) ? TIOCM_DSR : 0)
| ((status & CyCTS) ? TIOCM_CTS : 0);
} else {
base_addr = (unsigned char*) (cy_card[card].base_addr);
if (cy_card[card].num_chips != -1){
return -EINVAL;
}
firm_id = (struct FIRM_ID *)
(cy_card[card].base_addr + ID_ADDRESS);
if (ISZLOADED(cy_card[card])) {
zfw_ctrl = (struct ZFW_CTRL *)
(cy_card[card].base_addr +
(cy_readl(&firm_id->zfwctrl_addr) & 0xfffff));
board_ctrl = &zfw_ctrl->board_ctrl;
ch_ctrl = zfw_ctrl->ch_ctrl;
lstatus = cy_readl(&ch_ctrl[channel].rs_status);
result = ((lstatus & C_RS_RTS) ? TIOCM_RTS : 0)
| ((lstatus & C_RS_DTR) ? TIOCM_DTR : 0)
| ((lstatus & C_RS_DCD) ? TIOCM_CAR : 0)
| ((lstatus & C_RS_RI) ? TIOCM_RNG : 0)
| ((lstatus & C_RS_DSR) ? TIOCM_DSR : 0)
| ((lstatus & C_RS_CTS) ? TIOCM_CTS : 0);
}else{
result = 0;
return -ENODEV;
}
}
return cy_put_user(result, value);
} /* get_modem_info */
static int
set_modem_info(struct cyclades_port * info, unsigned int cmd,
unsigned int *value)
{
int card,chip,channel,index;
unsigned char *base_addr;
unsigned long flags;
unsigned int arg = cy_get_user((unsigned long *) value);
struct FIRM_ID *firm_id;
struct ZFW_CTRL *zfw_ctrl;
struct BOARD_CTRL *board_ctrl;
struct CH_CTRL *ch_ctrl;
int retval;
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
switch (cmd) {
case TIOCMBIS:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
}
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info raising DTRn");
printk(" status: 0x%x, 0x%xn",
cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
CY_UNLOCK(info, flags);
}
break;
case TIOCMBIC:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index),
(u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
}
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info dropping DTRn");
printk(" status: 0x%x, 0x%xn",
cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
CY_UNLOCK(info, flags);
}
break;
case TIOCMSET:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
}
CY_UNLOCK(info, flags);
}else{
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
}
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info raising DTRn");
printk(" status: 0x%x, 0x%xn",
cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
CY_UNLOCK(info, flags);
}else{
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
} else {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
}
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info dropping DTRn");
printk(" status: 0x%x, 0x%xn",
cy_readb(base_addr+(CyMSVR1<<index)),
cy_readb(base_addr+(CyMSVR2<<index)));
#endif
CY_UNLOCK(info, flags);
}
break;
default:
return -EINVAL;
}
} else {
base_addr = (unsigned char*) (cy_card[card].base_addr);
firm_id = (struct FIRM_ID *)
(cy_card[card].base_addr + ID_ADDRESS);
if (ISZLOADED(cy_card[card])) {
zfw_ctrl = (struct ZFW_CTRL *)
(cy_card[card].base_addr +
(cy_readl(&firm_id->zfwctrl_addr) & 0xfffff));
board_ctrl = &zfw_ctrl->board_ctrl;
ch_ctrl = zfw_ctrl->ch_ctrl;
switch (cmd) {
case TIOCMBIS:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) | C_RS_RTS);
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) | C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info raising Z DTRn");
#endif
CY_UNLOCK(info, flags);
}
break;
case TIOCMBIC:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) & ~C_RS_RTS);
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) & ~C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info clearing Z DTRn");
#endif
CY_UNLOCK(info, flags);
}
break;
case TIOCMSET:
if (arg & TIOCM_RTS){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) | C_RS_RTS);
CY_UNLOCK(info, flags);
}else{
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) & ~C_RS_RTS);
CY_UNLOCK(info, flags);
}
if (arg & TIOCM_DTR){
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) | C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info raising Z DTRn");
#endif
CY_UNLOCK(info, flags);
}else{
CY_LOCK(info, flags);
cy_writel(&ch_ctrl[channel].rs_control,
cy_readl(&ch_ctrl[channel].rs_control) & ~C_RS_DTR);
#ifdef CY_DEBUG_DTR
printk("cyc:set_modem_info clearing Z DTRn");
#endif
CY_UNLOCK(info, flags);
}
break;
default:
return -EINVAL;
}
}else{
return -ENODEV;
}
CY_LOCK(info, flags);
retval = cyz_issue_cmd(&cy_card[info->card],
channel, C_CM_IOCTLM,0L);
if (retval != 0){
printk("cyc:set_modem_info retval on ttyC%d was %xn",
info->line, retval);
}
CY_UNLOCK(info, flags);
}
return 0;
} /* set_modem_info */
/*
* cy_break() --- routine which turns the break handling on or off
*/
static void
cy_break(struct tty_struct *tty, int break_state)
{
struct cyclades_port * info = (struct cyclades_port *)tty->driver_data;
unsigned long flags;
if (serial_paranoia_check(info, tty->device, "cy_break"))
return;
CY_LOCK(info, flags);
if (!IS_CYC_Z(cy_card[info->card])) {
/* Let the transmit ISR take care of this (since it
requires stuffing characters into the output stream).
*/
if (break_state == -1) {
if (!info->breakon) {
info->breakon = 1;
if (!info->xmit_cnt) {
CY_UNLOCK(info, flags);
start_xmit(info);
CY_LOCK(info, flags);
}
}
} else {
if (!info->breakoff) {
info->breakoff = 1;
if (!info->xmit_cnt) {
CY_UNLOCK(info, flags);
start_xmit(info);
CY_LOCK(info, flags);
}
}
}
} else {
int retval;
if (break_state == -1) {
retval = cyz_issue_cmd(&cy_card[info->card],
(info->line) - (cy_card[info->card].first_line),
C_CM_SET_BREAK, 0L);
if (retval != 0) {
printk("cyc:cy_break (set) retval on ttyC%d was %xn",
info->line, retval);
}
} else {
retval = cyz_issue_cmd(&cy_card[info->card],
(info->line) - (cy_card[info->card].first_line),
C_CM_CLR_BREAK, 0L);
if (retval != 0) {
printk("cyc:cy_break (clr) retval on ttyC%d was %xn",
info->line, retval);
}
}
}
CY_UNLOCK(info, flags);
} /* cy_break */
static int
get_mon_info(struct cyclades_port * info, struct cyclades_monitor * mon)
{
if(copy_to_user(mon, &info->mon, sizeof(struct cyclades_monitor)))
return -EFAULT;
info->mon.int_count = 0;
info->mon.char_count = 0;
info->mon.char_max = 0;
info->mon.char_last = 0;
return 0;
}/* get_mon_info */
static int
set_threshold(struct cyclades_port * info, unsigned long value)
{
unsigned char *base_addr;
int card,channel,chip,index;
unsigned long flags;
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
info->cor3 &= ~CyREC_FIFO;
info->cor3 |= value & CyREC_FIFO;
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCOR3<<index), info->cor3);
cyy_issue_cmd(base_addr,CyCOR_CHANGE|CyCOR3ch,index);
CY_UNLOCK(info, flags);
} else {
// Nothing to do!
}
return 0;
}/* set_threshold */
static int
get_threshold(struct cyclades_port * info, unsigned long *value)
{
unsigned char *base_addr;
int card,channel,chip,index;
unsigned long tmp;
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
tmp = cy_readb(base_addr+(CyCOR3<<index)) & CyREC_FIFO;
return cy_put_user(tmp,value);
} else {
// Nothing to do!
return 0;
}
}/* get_threshold */
static int
set_default_threshold(struct cyclades_port * info, unsigned long value)
{
info->default_threshold = value & 0x0f;
return 0;
}/* set_default_threshold */
static int
get_default_threshold(struct cyclades_port * info, unsigned long *value)
{
return cy_put_user(info->default_threshold,value);
}/* get_default_threshold */
static int
set_timeout(struct cyclades_port * info, unsigned long value)
{
unsigned char *base_addr;
int card,channel,chip,index;
unsigned long flags;
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyRTPR<<index), value & 0xff);
CY_UNLOCK(info, flags);
} else {
// Nothing to do!
}
return 0;
}/* set_timeout */
static int
get_timeout(struct cyclades_port * info, unsigned long *value)
{
unsigned char *base_addr;
int card,channel,chip,index;
unsigned long tmp;
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
tmp = cy_readb(base_addr+(CyRTPR<<index));
return cy_put_user(tmp,value);
} else {
// Nothing to do!
return 0;
}
}/* get_timeout */
static int
set_default_timeout(struct cyclades_port * info, unsigned long value)
{
info->default_timeout = value & 0xff;
return 0;
}/* set_default_timeout */
static int
get_default_timeout(struct cyclades_port * info, unsigned long *value)
{
return cy_put_user(info->default_timeout,value);
}/* get_default_timeout */
/*
* This routine allows the tty driver to implement device-
* specific ioctl's. If the ioctl number passed in cmd is
* not recognized by the driver, it should return ENOIOCTLCMD.
*/
static int
cy_ioctl(struct tty_struct *tty, struct file * file,
unsigned int cmd, unsigned long arg)
{
struct cyclades_port * info = (struct cyclades_port *)tty->driver_data;
struct cyclades_icount cprev, cnow; /* kernel counter temps */
struct serial_icounter_struct *p_cuser; /* user space */
int ret_val = 0;
unsigned long flags;
if (serial_paranoia_check(info, tty->device, "cy_ioctl"))
return -ENODEV;
#ifdef CY_DEBUG_OTHER
printk("cyc:cy_ioctl ttyC%d, cmd = %x arg = %lxn",
info->line, cmd, arg); /* */
#endif
switch (cmd) {
case CYGETMON:
ret_val = get_mon_info(info, (struct cyclades_monitor *)arg);
break;
case CYGETTHRESH:
ret_val = get_threshold(info, (unsigned long *)arg);
break;
case CYSETTHRESH:
ret_val = set_threshold(info, (unsigned long)arg);
break;
case CYGETDEFTHRESH:
ret_val = get_default_threshold(info, (unsigned long *)arg);
break;
case CYSETDEFTHRESH:
ret_val = set_default_threshold(info, (unsigned long)arg);
break;
case CYGETTIMEOUT:
ret_val = get_timeout(info, (unsigned long *)arg);
break;
case CYSETTIMEOUT:
ret_val = set_timeout(info, (unsigned long)arg);
break;
case CYGETDEFTIMEOUT:
ret_val = get_default_timeout(info, (unsigned long *)arg);
break;
case CYSETDEFTIMEOUT:
ret_val = set_default_timeout(info, (unsigned long)arg);
break;
case CYSETRFLOW:
info->rflow = (int)arg;
ret_val = 0;
break;
case CYGETRFLOW:
ret_val = info->rflow;
break;
case CYSETRTSDTR_INV:
info->rtsdtr_inv = (int)arg;
ret_val = 0;
break;
case CYGETRTSDTR_INV:
ret_val = info->rtsdtr_inv;
break;
case CYGETCARDINFO:
if (copy_to_user((void *)arg, (void *)&cy_card[info->card],
sizeof (struct cyclades_card))) {
ret_val = -EFAULT;
break;
}
ret_val = 0;
break;
case CYGETCD1400VER:
ret_val = info->chip_rev;
break;
#ifndef CONFIG_CYZ_INTR
case CYZSETPOLLCYCLE:
cyz_polling_cycle = (arg * HZ) / 1000;
ret_val = 0;
break;
case CYZGETPOLLCYCLE:
ret_val = (cyz_polling_cycle * 1000) / HZ;
break;
#endif /* CONFIG_CYZ_INTR */
case CYSETWAIT:
info->closing_wait = (unsigned short)arg * HZ/100;
ret_val = 0;
break;
case CYGETWAIT:
ret_val = info->closing_wait / (HZ/100);
break;
case TIOCMGET:
ret_val = get_modem_info(info, (unsigned int *) arg);
break;
case TIOCMBIS:
case TIOCMBIC:
case TIOCMSET:
ret_val = set_modem_info(info, cmd, (unsigned int *) arg);
break;
case TIOCGSERIAL:
ret_val = get_serial_info(info, (struct serial_struct *) arg);
break;
case TIOCSSERIAL:
ret_val = set_serial_info(info, (struct serial_struct *) arg);
break;
case TIOCSERGETLSR: /* Get line status register */
ret_val = get_lsr_info(info, (unsigned int *) arg);
break;
/*
* Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
* - mask passed in arg for lines of interest
* (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
* Caller should use TIOCGICOUNT to see which one it was
*/
case TIOCMIWAIT:
CY_LOCK(info, flags);
/* note the counters on entry */
cprev = info->icount;
CY_UNLOCK(info, flags);
while (1) {
interruptible_sleep_on(&info->delta_msr_wait);
/* see if a signal did it */
if (signal_pending(current)) {
return -ERESTARTSYS;
}
CY_LOCK(info, flags);
cnow = info->icount; /* atomic copy */
CY_UNLOCK(info, flags);
if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) {
return -EIO; /* no change => error */
}
if ( ((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
return 0;
}
cprev = cnow;
}
/* NOTREACHED */
/*
* Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
* Return: write counters to the user passed counter struct
* NB: both 1->0 and 0->1 transitions are counted except for
* RI where only 0->1 is counted.
*/
case TIOCGICOUNT:
CY_LOCK(info, flags);
cnow = info->icount;
CY_UNLOCK(info, flags);
p_cuser = (struct serial_icounter_struct *) arg;
ret_val = put_user(cnow.cts, &p_cuser->cts);
if (ret_val) return ret_val;
ret_val = put_user(cnow.dsr, &p_cuser->dsr);
if (ret_val) return ret_val;
ret_val = put_user(cnow.rng, &p_cuser->rng);
if (ret_val) return ret_val;
ret_val = put_user(cnow.dcd, &p_cuser->dcd);
if (ret_val) return ret_val;
ret_val = put_user(cnow.rx, &p_cuser->rx);
if (ret_val) return ret_val;
ret_val = put_user(cnow.tx, &p_cuser->tx);
if (ret_val) return ret_val;
ret_val = put_user(cnow.frame, &p_cuser->frame);
if (ret_val) return ret_val;
ret_val = put_user(cnow.overrun, &p_cuser->overrun);
if (ret_val) return ret_val;
ret_val = put_user(cnow.parity, &p_cuser->parity);
if (ret_val) return ret_val;
ret_val = put_user(cnow.brk, &p_cuser->brk);
if (ret_val) return ret_val;
ret_val = put_user(cnow.buf_overrun, &p_cuser->buf_overrun);
if (ret_val) return ret_val;
ret_val = 0;
break;
default:
ret_val = -ENOIOCTLCMD;
}
#ifdef CY_DEBUG_OTHER
printk(" cyc:cy_ioctl donen");
#endif
return ret_val;
} /* cy_ioctl */
/*
* This routine allows the tty driver to be notified when
* device's termios settings have changed. Note that a
* well-designed tty driver should be prepared to accept the case
* where old == NULL, and try to do something rational.
*/
static void
cy_set_termios(struct tty_struct *tty, struct termios * old_termios)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
#ifdef CY_DEBUG_OTHER
printk("cyc:cy_set_termios ttyC%dn", info->line);
#endif
if ((tty->termios->c_cflag == old_termios->c_cflag) &&
((tty->termios->c_iflag & (IXON|IXANY)) ==
(old_termios->c_iflag & (IXON|IXANY))))
return;
set_line_char(info);
if ((old_termios->c_cflag & CRTSCTS) &&
!(tty->termios->c_cflag & CRTSCTS)) {
tty->hw_stopped = 0;
cy_start(tty);
}
#if 0
/*
* No need to wake up processes in open wait, since they
* sample the CLOCAL flag once, and don't recheck it.
* XXX It's not clear whether the current behavior is correct
* or not. Hence, this may change.....
*/
if (!(old_termios->c_cflag & CLOCAL) &&
(tty->termios->c_cflag & CLOCAL))
wake_up_interruptible(&info->open_wait);
#endif
return;
} /* cy_set_termios */
/* This routine is called by the upper-layer tty layer to signal
that incoming characters should be throttled because the input
buffers are close to full.
*/
static void
cy_throttle(struct tty_struct * tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned long flags;
unsigned char *base_addr;
int card,chip,channel,index;
#ifdef CY_DEBUG_THROTTLE
char buf[64];
printk("cyc:throttle %s: %d....ttyC%dn",
tty_name(tty, buf),
tty->ldisc.chars_in_buffer(tty), info->line);
#endif
if (serial_paranoia_check(info, tty->device, "cy_throttle")){
return;
}
if (I_IXOFF(tty)) {
info->x_char = STOP_CHAR(tty);
/* Should use the "Send Special Character" feature!!! */
}
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), ~CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), ~CyRTS);
}
CY_UNLOCK(info, flags);
} else {
// Nothing to do!
}
return;
} /* cy_throttle */
/*
* This routine notifies the tty driver that it should signal
* that characters can now be sent to the tty without fear of
* overrunning the input buffers of the line disciplines.
*/
static void
cy_unthrottle(struct tty_struct * tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned long flags;
unsigned char *base_addr;
int card,chip,channel,index;
#ifdef CY_DEBUG_THROTTLE
char buf[64];
printk("cyc:unthrottle %s: %d....ttyC%dn",
tty_name(tty, buf),
tty->ldisc.chars_in_buffer(tty), info->line);
#endif
if (serial_paranoia_check(info, tty->device, "cy_unthrottle")){
return;
}
if (I_IXOFF(tty)) {
if (info->x_char)
info->x_char = 0;
else
info->x_char = START_CHAR(tty);
/* Should use the "Send Special Character" feature!!! */
}
card = info->card;
channel = info->line - cy_card[card].first_line;
if (!IS_CYC_Z(cy_card[card])) {
chip = channel>>2;
channel &= 0x03;
index = cy_card[card].bus_index;
base_addr = (unsigned char*)
(cy_card[card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index), (u_char)channel);
if (info->rtsdtr_inv) {
cy_writeb((u_long)base_addr+(CyMSVR2<<index), CyDTR);
} else {
cy_writeb((u_long)base_addr+(CyMSVR1<<index), CyRTS);
}
CY_UNLOCK(info, flags);
}else{
// Nothing to do!
}
return;
} /* cy_unthrottle */
/* cy_start and cy_stop provide software output flow control as a
function of XON/XOFF, software CTS, and other such stuff.
*/
static void
cy_stop(struct tty_struct *tty)
{
struct cyclades_card *cinfo;
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned char *base_addr;
int chip,channel,index;
unsigned long flags;
#ifdef CY_DEBUG_OTHER
printk("cyc:cy_stop ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_stop"))
return;
cinfo = &cy_card[info->card];
channel = info->line - cinfo->first_line;
if (!IS_CYC_Z(*cinfo)) {
index = cinfo->bus_index;
chip = channel>>2;
channel &= 0x03;
base_addr = (unsigned char*)
(cy_card[info->card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index),
(u_char)(channel & 0x0003)); /* index channel */
cy_writeb((u_long)base_addr+(CySRER<<index),
cy_readb(base_addr+(CySRER<<index)) & ~CyTxRdy);
CY_UNLOCK(info, flags);
} else {
// Nothing to do!
}
return;
} /* cy_stop */
static void
cy_start(struct tty_struct *tty)
{
struct cyclades_card *cinfo;
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
unsigned char *base_addr;
int chip,channel,index;
unsigned long flags;
#ifdef CY_DEBUG_OTHER
printk("cyc:cy_start ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_start"))
return;
cinfo = &cy_card[info->card];
channel = info->line - cinfo->first_line;
index = cinfo->bus_index;
if (!IS_CYC_Z(*cinfo)) {
chip = channel>>2;
channel &= 0x03;
base_addr = (unsigned char*)
(cy_card[info->card].base_addr
+ (cy_chip_offset[chip]<<index));
CY_LOCK(info, flags);
cy_writeb((u_long)base_addr+(CyCAR<<index),
(u_char)(channel & 0x0003)); /* index channel */
cy_writeb((u_long)base_addr+(CySRER<<index),
cy_readb(base_addr+(CySRER<<index)) | CyTxRdy);
CY_UNLOCK(info, flags);
} else {
// Nothing to do!
}
return;
} /* cy_start */
static void
cy_flush_buffer(struct tty_struct *tty)
{
struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
int card, channel, retval;
unsigned long flags;
#ifdef CY_DEBUG_IO
printk("cyc:cy_flush_buffer ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_flush_buffer"))
return;
card = info->card;
channel = (info->line) - (cy_card[card].first_line);
CY_LOCK(info, flags);
info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
CY_UNLOCK(info, flags);
if (IS_CYC_Z(cy_card[card])) { /* If it is a Z card, flush the on-board
buffers as well */
CY_LOCK(info, flags);
retval = cyz_issue_cmd(&cy_card[card], channel, C_CM_FLUSH_TX, 0L);
if (retval != 0) {
printk("cyc: flush_buffer retval on ttyC%d was %xn",
info->line, retval);
}
CY_UNLOCK(info, flags);
}
wake_up_interruptible(&tty->write_wait);
if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP))
&& tty->ldisc.write_wakeup)
(tty->ldisc.write_wakeup)(tty);
} /* cy_flush_buffer */
/*
* cy_hangup() --- called by tty_hangup() when a hangup is signaled.
*/
static void
cy_hangup(struct tty_struct *tty)
{
struct cyclades_port * info = (struct cyclades_port *)tty->driver_data;
#ifdef CY_DEBUG_OTHER
printk("cyc:cy_hangup ttyC%dn", info->line); /* */
#endif
if (serial_paranoia_check(info, tty->device, "cy_hangup"))
return;
cy_flush_buffer(tty);
shutdown(info);
info->event = 0;
info->count = 0;
#ifdef CY_DEBUG_COUNT
printk("cyc:cy_hangup (%d): setting count to 0n", current->pid);
#endif
info->tty = 0;
info->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CALLOUT_ACTIVE);
wake_up_interruptible(&info->open_wait);
} /* cy_hangup */
/*
* ---------------------------------------------------------------------
* cy_init() and friends
*
* cy_init() is called at boot-time to initialize the serial driver.
* ---------------------------------------------------------------------
*/
/* initialize chips on Cyclom-Y card -- return number of valid
chips (which is number of ports/4) */
static unsigned short __init
cyy_init_card(volatile ucchar *true_base_addr,int index)
{
unsigned int chip_number;
volatile ucchar* base_addr;
cy_writeb((u_long)true_base_addr+(Cy_HwReset<<index), 0);
/* Cy_HwReset is 0x1400 */
cy_writeb((u_long)true_base_addr+(Cy_ClrIntr<<index), 0);
/* Cy_ClrIntr is 0x1800 */
udelay(500L);
for(chip_number=0; chip_number<CyMAX_CHIPS_PER_CARD; chip_number++){
base_addr = true_base_addr
+ (cy_chip_offset[chip_number]<<index);
mdelay(1);
if(cy_readb(base_addr+(CyCCR<<index)) != 0x00){
/*************
printk(" chip #%d at %#6lx is never idle (CCR != 0)n",
chip_number, (unsigned long)base_addr);
*************/
return chip_number;
}
cy_writeb((u_long)base_addr+(CyGFRCR<<index), 0);
udelay(10L);
/* The Cyclom-16Y does not decode address bit 9 and therefore
cannot distinguish between references to chip 0 and a non-
existent chip 4. If the preceding clearing of the supposed
chip 4 GFRCR register appears at chip 0, there is no chip 4
and this must be a Cyclom-16Y, not a Cyclom-32Ye.
*/
if (chip_number == 4
&& cy_readb(true_base_addr
+ (cy_chip_offset[0]<<index)
+ (CyGFRCR<<index)) == 0){
return chip_number;
}
cy_writeb((u_long)base_addr+(CyCCR<<index), CyCHIP_RESET);
mdelay(1);
if(cy_readb(base_addr+(CyGFRCR<<index)) == 0x00){
/*
printk(" chip #%d at %#6lx is not responding ",
chip_number, (unsigned long)base_addr);
printk("(GFRCR stayed 0)n",
*/
return chip_number;
}
if((0xf0 & (cy_readb(base_addr+(CyGFRCR<<index)))) != 0x40){
/*
printk(" chip #%d at %#6lx is not valid (GFRCR == %#2x)n",
chip_number, (unsigned long)base_addr,
base_addr[CyGFRCR<<index]);
*/
return chip_number;
}
cy_writeb((u_long)base_addr+(CyGCR<<index), CyCH0_SERIAL);
if (cy_readb(base_addr+(CyGFRCR<<index)) >= CD1400_REV_J){
/* It is a CD1400 rev. J or later */
/* Impossible to reach 5ms with this chip.
Changed to 2ms instead (f = 500 Hz). */
cy_writeb((u_long)base_addr+(CyPPR<<index), CyCLOCK_60_2MS);
} else {
/* f = 200 Hz */
cy_writeb((u_long)base_addr+(CyPPR<<index), CyCLOCK_25_5MS);
}
/*
printk(" chip #%d at %#6lx is rev 0x%2xn",
chip_number, (unsigned long)base_addr,
cy_readb(base_addr+(CyGFRCR<<index)));
*/
}
return chip_number;
} /* cyy_init_card */
/*
* ---------------------------------------------------------------------
* cy_detect_isa() - Probe for Cyclom-Y/ISA boards.
* sets global variables and return the number of ISA boards found.
* ---------------------------------------------------------------------
*/
static int __init
cy_detect_isa(void)
{
#ifdef CONFIG_ISA
unsigned short cy_isa_irq,nboard;
volatile ucchar *cy_isa_address;
unsigned short i,j,cy_isa_nchan;
#ifdef MODULE
int isparam = 0;
#endif
nboard = 0;
#ifdef MODULE
/* Check for module parameters */
for(i = 0 ; i < NR_CARDS; i++) {
if (maddr[i] || i) {
isparam = 1;
cy_isa_addresses[i] = (ucchar *)maddr[i];
}
if (!maddr[i])
break;
}
#endif
/* scan the address table probing for Cyclom-Y/ISA boards */
for (i = 0 ; i < NR_ISA_ADDRS ; i++) {
cy_isa_address = cy_isa_addresses[i];
if (cy_isa_address == 0x0000) {
return(nboard);
}
/* probe for CD1400... */
#if !defined(__alpha__)
cy_isa_address = ioremap((ulong)cy_isa_address, CyISA_Ywin);
#endif
cy_isa_nchan = CyPORTS_PER_CHIP *
cyy_init_card(cy_isa_address,0);
if (cy_isa_nchan == 0) {
continue;
}
#ifdef MODULE
if (isparam && irq[i])
cy_isa_irq = irq[i];
else
#endif
/* find out the board's irq by probing */
cy_isa_irq = detect_isa_irq(cy_isa_address);
if (cy_isa_irq == 0) {
printk("Cyclom-Y/ISA found at 0x%lx ",
(unsigned long) cy_isa_address);
printk("but the IRQ could not be detected.n");
continue;
}
if((cy_next_channel+cy_isa_nchan) > NR_PORTS) {
printk("Cyclom-Y/ISA found at 0x%lx ",
(unsigned long) cy_isa_address);
printk("but no more channels are available.n");
printk("Change NR_PORTS in cyclades.c and recompile kernel.n");
return(nboard);
}
/* fill the next cy_card structure available */
for (j = 0 ; j < NR_CARDS ; j++) {
if (cy_card[j].base_addr == 0) break;
}
if (j == NR_CARDS) { /* no more cy_cards available */
printk("Cyclom-Y/ISA found at 0x%lx ",
(unsigned long) cy_isa_address);
printk("but no more cards can be used .n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
return(nboard);
}
/* allocate IRQ */
if(request_irq(cy_isa_irq, cyy_interrupt,
SA_INTERRUPT, "Cyclom-Y", &cy_card[j]))
{
printk("Cyclom-Y/ISA found at 0x%lx ",
(unsigned long) cy_isa_address);
printk("but could not allocate IRQ#%d.n",
cy_isa_irq);
return(nboard);
}
/* set cy_card */
cy_card[j].base_addr = (u_long) cy_isa_address;
cy_card[j].ctl_addr = 0;
cy_card[j].irq = (int) cy_isa_irq;
cy_card[j].bus_index = 0;
cy_card[j].first_line = cy_next_channel;
cy_card[j].num_chips = cy_isa_nchan/4;
nboard++;
/* print message */
printk("Cyclom-Y/ISA #%d: 0x%lx-0x%lx, IRQ%d, ",
j+1, (unsigned long) cy_isa_address,
(unsigned long)(cy_isa_address + (CyISA_Ywin - 1)),
cy_isa_irq);
printk("%d channels starting from port %d.n",
cy_isa_nchan, cy_next_channel);
cy_next_channel += cy_isa_nchan;
}
return(nboard);
#else
return(0);
#endif /* CONFIG_ISA */
} /* cy_detect_isa */
static void
plx_init(uclong addr, uclong initctl)
{
/* Reset PLX */
cy_writel(addr + initctl, cy_readl(addr + initctl) | 0x40000000);
udelay(100L);
cy_writel(addr + initctl, cy_readl(addr + initctl) & ~0x40000000);
/* Reload Config. Registers from EEPROM */
cy_writel(addr + initctl, cy_readl(addr + initctl) | 0x20000000);
udelay(100L);
cy_writel(addr + initctl, cy_readl(addr + initctl) & ~0x20000000);
}
/*
* ---------------------------------------------------------------------
* cy_detect_pci() - Test PCI bus presence and Cyclom-Ye/PCI.
* sets global variables and return the number of PCI boards found.
* ---------------------------------------------------------------------
*/
static int __init
cy_detect_pci(void)
{
#ifdef CONFIG_PCI
struct pci_dev *pdev = NULL;
unsigned char cyy_rev_id;
unsigned char cy_pci_irq = 0;
uclong cy_pci_phys0, cy_pci_phys1, cy_pci_phys2;
uclong cy_pci_addr0, cy_pci_addr2;
unsigned short i,j,cy_pci_nchan, plx_ver;
unsigned short device_id,dev_index = 0;
uclong mailbox;
uclong Ze_addr0[NR_CARDS], Ze_addr2[NR_CARDS], ZeIndex = 0;
uclong Ze_phys0[NR_CARDS], Ze_phys2[NR_CARDS];
unsigned char Ze_irq[NR_CARDS];
struct resource *resource;
unsigned long res_start, res_len;
for (i = 0; i < NR_CARDS; i++) {
/* look for a Cyclades card by vendor and device id */
while((device_id = cy_pci_dev_id[dev_index]) != 0) {
if((pdev = pci_find_device(PCI_VENDOR_ID_CYCLADES,
device_id, pdev)) == NULL) {
dev_index++; /* try next device id */
} else {
break; /* found a board */
}
}
if (device_id == 0)
break;
if (pci_enable_device(pdev))
continue;
/* read PCI configuration area */
cy_pci_irq = pdev->irq;
cy_pci_phys0 = pci_resource_start(pdev, 0);
cy_pci_phys1 = pci_resource_start(pdev, 1);
cy_pci_phys2 = pci_resource_start(pdev, 2);
pci_read_config_byte(pdev, PCI_REVISION_ID, &cyy_rev_id);
device_id &= ~PCI_DEVICE_ID_MASK;
if ((device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo)
|| (device_id == PCI_DEVICE_ID_CYCLOM_Y_Hi)){
#ifdef CY_PCI_DEBUG
printk("Cyclom-Y/PCI (bus=0x0%x, pci_id=0x%x, ",
pdev->bus->number, pdev->devfn);
printk("rev_id=%d) IRQ%dn",
cyy_rev_id, (int)cy_pci_irq);
printk("Cyclom-Y/PCI:found winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_phys2, (ulong)cy_pci_phys0);
#endif
if (pci_resource_flags(pdev, 2) & IORESOURCE_IO) {
printk(" Warning: PCI I/O bit incorrectly set. "
"Ignoring it...n");
pdev->resource[2].flags &= ~IORESOURCE_IO;
}
/* Although we don't use this I/O region, we should
request it from the kernel anyway, to avoid problems
with other drivers accessing it. */
resource = request_region(cy_pci_phys1, CyPCI_Yctl, "Cyclom-Y");
if (resource == NULL) {
printk(KERN_ERR "cyclades: failed to allocate IO "
"resource at 0x%lxn", cy_pci_phys1);
continue;
}
res_start = cy_pci_phys1;
res_len = CyPCI_Yctl;
#if defined(__alpha__)
if (device_id == PCI_DEVICE_ID_CYCLOM_Y_Lo) { /* below 1M? */
printk("Cyclom-Y/PCI (bus=0x0%x, pci_id=0x%x, ",
pdev->bus->number, pdev->devfn);
printk("rev_id=%d) IRQ%dn",
cyy_rev_id, (int)cy_pci_irq);
printk("Cyclom-Y/PCI:found winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_phys2, (ulong)cy_pci_phys0);
printk("Cyclom-Y/PCI not supported for low addresses in "
"Alpha systems.n");
i--;
continue;
}
#endif
cy_pci_addr0 = (ulong)ioremap(cy_pci_phys0, CyPCI_Yctl);
cy_pci_addr2 = (ulong)ioremap(cy_pci_phys2, CyPCI_Ywin);
#ifdef CY_PCI_DEBUG
printk("Cyclom-Y/PCI: relocate winaddr=0x%lx ctladdr=0x%lxn",
(u_long)cy_pci_addr2, (u_long)cy_pci_addr0);
#endif
cy_pci_nchan = (unsigned short)(CyPORTS_PER_CHIP *
cyy_init_card((volatile ucchar *)cy_pci_addr2, 1));
if(cy_pci_nchan == 0) {
printk("Cyclom-Y PCI host card with ");
printk("no Serial-Modules at 0x%lx.n",
(ulong) cy_pci_phys2);
i--;
continue;
}
if((cy_next_channel+cy_pci_nchan) > NR_PORTS) {
printk("Cyclom-Y/PCI found at 0x%lx ",
(ulong) cy_pci_phys2);
printk("but no channels are available.n");
printk("Change NR_PORTS in cyclades.c and recompile kernel.n");
return(i);
}
/* fill the next cy_card structure available */
for (j = 0 ; j < NR_CARDS ; j++) {
if (cy_card[j].base_addr == 0) break;
}
if (j == NR_CARDS) { /* no more cy_cards available */
printk("Cyclom-Y/PCI found at 0x%lx ",
(ulong) cy_pci_phys2);
printk("but no more cards can be used.n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
return(i);
}
/* allocate IRQ */
if(request_irq(cy_pci_irq, cyy_interrupt,
SA_SHIRQ, "Cyclom-Y", &cy_card[j]))
{
printk("Cyclom-Y/PCI found at 0x%lx ",
(ulong) cy_pci_phys2);
printk("but could not allocate IRQ%d.n",
cy_pci_irq);
return(i);
}
/* set cy_card */
cy_card[j].base_phys = (ulong)cy_pci_phys2;
cy_card[j].ctl_phys = (ulong)cy_pci_phys0;
cy_card[j].base_addr = (ulong)cy_pci_addr2;
cy_card[j].ctl_addr = (ulong)cy_pci_addr0;
cy_card[j].irq = (int) cy_pci_irq;
cy_card[j].bus_index = 1;
cy_card[j].first_line = cy_next_channel;
cy_card[j].num_chips = cy_pci_nchan/4;
cy_card[j].resource = resource;
cy_card[j].res_start = res_start;
cy_card[j].res_len = res_len;
resource = NULL; /* For next card */
/* enable interrupts in the PCI interface */
plx_ver = cy_readb(cy_pci_addr2 + CyPLX_VER) & 0x0f;
switch (plx_ver) {
case PLX_9050:
cy_writeb(cy_pci_addr0+0x4c, 0x43);
break;
case PLX_9060:
case PLX_9080:
default: /* Old boards, use PLX_9060 */
plx_init(cy_pci_addr0, 0x6c);
/* For some yet unknown reason, once the PLX9060 reloads
the EEPROM, the IRQ is lost and, thus, we have to
re-write it to the PCI config. registers.
This will remain here until we find a permanent fix. */
pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, cy_pci_irq);
cy_writew(cy_pci_addr0+0x68,
cy_readw(cy_pci_addr0+0x68)|0x0900);
break;
}
/* print message */
printk("Cyclom-Y/PCI #%d: 0x%lx-0x%lx, IRQ%d, ",
j+1,
(ulong)cy_pci_phys2,
(ulong)(cy_pci_phys2 + CyPCI_Ywin - 1),
(int)cy_pci_irq);
printk("%d channels starting from port %d.n",
cy_pci_nchan, cy_next_channel);
cy_next_channel += cy_pci_nchan;
}else if (device_id == PCI_DEVICE_ID_CYCLOM_Z_Lo){
/* print message */
printk("Cyclades-Z/PCI (bus=0x0%x, pci_id=0x%x, ",
pdev->bus->number, pdev->devfn);
printk("rev_id=%d) IRQ%dn",
cyy_rev_id, (int)cy_pci_irq);
printk("Cyclades-Z/PCI: found winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_phys2, (ulong)cy_pci_phys0);
printk("Cyclades-Z/PCI not supported for low addressesn");
break;
}else if (device_id == PCI_DEVICE_ID_CYCLOM_Z_Hi){
#ifdef CY_PCI_DEBUG
printk("Cyclades-Z/PCI (bus=0x0%x, pci_id=0x%x, ",
pdev->bus->number, pdev->devfn);
printk("rev_id=%d) IRQ%dn",
cyy_rev_id, (int)cy_pci_irq);
printk("Cyclades-Z/PCI: found winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_phys2, (ulong)cy_pci_phys0);
#endif
cy_pci_addr0 = (ulong)ioremap(cy_pci_phys0, CyPCI_Zctl);
/* Disable interrupts on the PLX before resetting it */
cy_writew(cy_pci_addr0+0x68,
cy_readw(cy_pci_addr0+0x68) & ~0x0900);
plx_init(cy_pci_addr0, 0x6c);
/* For some yet unknown reason, once the PLX9060 reloads
the EEPROM, the IRQ is lost and, thus, we have to
re-write it to the PCI config. registers.
This will remain here until we find a permanent fix. */
pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, cy_pci_irq);
mailbox = (uclong)cy_readl(&((struct RUNTIME_9060 *)
cy_pci_addr0)->mail_box_0);
if (pci_resource_flags(pdev, 2) & IORESOURCE_IO) {
printk(" Warning: PCI I/O bit incorrectly set. "
"Ignoring it...n");
pdev->resource[2].flags &= ~IORESOURCE_IO;
}
/* Although we don't use this I/O region, we should
request it from the kernel anyway, to avoid problems
with other drivers accessing it. */
request_region(cy_pci_phys1, CyPCI_Zctl, "Cyclades-Z");
resource = request_region(cy_pci_phys1, CyPCI_Zctl,
"Cyclades-Z");
if (resource == NULL) {
printk(KERN_ERR "cyclades: failed to allocate IO "
"resource at 0x%lxn", cy_pci_phys1);
continue;
}
res_start = cy_pci_phys1;
res_len = CyPCI_Zctl;
if (mailbox == ZE_V1) {
cy_pci_addr2 = (ulong)ioremap(cy_pci_phys2, CyPCI_Ze_win);
if (ZeIndex == NR_CARDS) {
printk("Cyclades-Ze/PCI found at 0x%lx ",
(ulong)cy_pci_phys2);
printk("but no more cards can be used.n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
} else {
Ze_phys0[ZeIndex] = cy_pci_phys0;
Ze_phys2[ZeIndex] = cy_pci_phys2;
Ze_addr0[ZeIndex] = cy_pci_addr0;
Ze_addr2[ZeIndex] = cy_pci_addr2;
Ze_irq[ZeIndex] = cy_pci_irq;
ZeIndex++;
}
i--;
continue;
} else {
cy_pci_addr2 = (ulong)ioremap(cy_pci_phys2, CyPCI_Zwin);
}
#ifdef CY_PCI_DEBUG
printk("Cyclades-Z/PCI: relocate winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_addr2, (ulong)cy_pci_addr0);
if (mailbox == ZO_V1) {
cy_writel(&((struct RUNTIME_9060 *)
(cy_pci_addr0))->loc_addr_base, WIN_CREG);
PAUSE
printk("Cyclades-8Zo/PCI: FPGA id %lx, ver %lxn",
(ulong)(0xff & cy_readl(&((struct CUSTOM_REG *)
(cy_pci_addr2))->fpga_id)),
(ulong)(0xff & cy_readl(&((struct CUSTOM_REG *)
(cy_pci_addr2))->fpga_version)));
cy_writel(&((struct RUNTIME_9060 *)
(cy_pci_addr0))->loc_addr_base, WIN_RAM);
} else {
printk("Cyclades-Z/PCI: New Cyclades-Z board. FPGA not loadedn");
}
#endif
/* The following clears the firmware id word. This ensures
that the driver will not attempt to talk to the board
until it has been properly initialized.
*/
PAUSE
if ((mailbox == ZO_V1) || (mailbox == ZO_V2))
cy_writel((ulong)(cy_pci_addr2+ID_ADDRESS), 0L);
/* This must be a Cyclades-8Zo/PCI. The extendable
version will have a different device_id and will
be allocated its maximum number of ports. */
cy_pci_nchan = 8;
if((cy_next_channel+cy_pci_nchan) > NR_PORTS) {
printk("Cyclades-8Zo/PCI found at 0x%lx ",
(ulong)cy_pci_phys2);
printk("but no channels are available.n");
printk("Change NR_PORTS in cyclades.c and recompile kernel.n");
return(i);
}
/* fill the next cy_card structure available */
for (j = 0 ; j < NR_CARDS ; j++) {
if (cy_card[j].base_addr == 0) break;
}
if (j == NR_CARDS) { /* no more cy_cards available */
printk("Cyclades-8Zo/PCI found at 0x%lx ",
(ulong)cy_pci_phys2);
printk("but no more cards can be used.n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
return(i);
}
#ifdef CONFIG_CYZ_INTR
/* allocate IRQ only if board has an IRQ */
if( (cy_pci_irq != 0) && (cy_pci_irq != 255) ) {
if(request_irq(cy_pci_irq, cyz_interrupt,
SA_SHIRQ, "Cyclades-Z", &cy_card[j]))
{
printk("Cyclom-8Zo/PCI found at 0x%lx ",
(ulong) cy_pci_phys2);
printk("but could not allocate IRQ%d.n",
cy_pci_irq);
return(i);
}
}
#endif /* CONFIG_CYZ_INTR */
/* set cy_card */
cy_card[j].base_phys = cy_pci_phys2;
cy_card[j].ctl_phys = cy_pci_phys0;
cy_card[j].base_addr = cy_pci_addr2;
cy_card[j].ctl_addr = cy_pci_addr0;
cy_card[j].irq = (int) cy_pci_irq;
cy_card[j].bus_index = 1;
cy_card[j].first_line = cy_next_channel;
cy_card[j].num_chips = -1;
cy_card[j].resource = resource;
cy_card[j].res_start = res_start;
cy_card[j].res_len = res_len;
resource = NULL; /* For next card */
/* print message */
#ifdef CONFIG_CYZ_INTR
/* don't report IRQ if board is no IRQ */
if( (cy_pci_irq != 0) && (cy_pci_irq != 255) )
printk("Cyclades-8Zo/PCI #%d: 0x%lx-0x%lx, IRQ%d, ",
j+1,(ulong)cy_pci_phys2,
(ulong)(cy_pci_phys2 + CyPCI_Zwin - 1),
(int)cy_pci_irq);
else
#endif /* CONFIG_CYZ_INTR */
printk("Cyclades-8Zo/PCI #%d: 0x%lx-0x%lx, ",
j+1,(ulong)cy_pci_phys2,
(ulong)(cy_pci_phys2 + CyPCI_Zwin - 1));
printk("%d channels starting from port %d.n",
cy_pci_nchan,cy_next_channel);
cy_next_channel += cy_pci_nchan;
}
}
for (; ZeIndex != 0 && i < NR_CARDS; i++) {
cy_pci_phys0 = Ze_phys0[0];
cy_pci_phys2 = Ze_phys2[0];
cy_pci_addr0 = Ze_addr0[0];
cy_pci_addr2 = Ze_addr2[0];
cy_pci_irq = Ze_irq[0];
for (j = 0 ; j < ZeIndex-1 ; j++) {
Ze_phys0[j] = Ze_phys0[j+1];
Ze_phys2[j] = Ze_phys2[j+1];
Ze_addr0[j] = Ze_addr0[j+1];
Ze_addr2[j] = Ze_addr2[j+1];
Ze_irq[j] = Ze_irq[j+1];
}
ZeIndex--;
mailbox = (uclong)cy_readl(&((struct RUNTIME_9060 *)
cy_pci_addr0)->mail_box_0);
#ifdef CY_PCI_DEBUG
printk("Cyclades-Z/PCI: relocate winaddr=0x%lx ctladdr=0x%lxn",
(ulong)cy_pci_addr2, (ulong)cy_pci_addr0);
printk("Cyclades-Z/PCI: New Cyclades-Z board. FPGA not loadedn");
#endif
PAUSE
/* This must be the new Cyclades-Ze/PCI. */
cy_pci_nchan = ZE_V1_NPORTS;
if((cy_next_channel+cy_pci_nchan) > NR_PORTS) {
printk("Cyclades-Ze/PCI found at 0x%lx ",
(ulong)cy_pci_phys2);
printk("but no channels are available.n");
printk("Change NR_PORTS in cyclades.c and recompile kernel.n");
return(i);
}
/* fill the next cy_card structure available */
for (j = 0 ; j < NR_CARDS ; j++) {
if (cy_card[j].base_addr == 0) break;
}
if (j == NR_CARDS) { /* no more cy_cards available */
printk("Cyclades-Ze/PCI found at 0x%lx ",
(ulong)cy_pci_phys2);
printk("but no more cards can be used.n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
return(i);
}
#ifdef CONFIG_CYZ_INTR
/* allocate IRQ only if board has an IRQ */
if( (cy_pci_irq != 0) && (cy_pci_irq != 255) ) {
if(request_irq(cy_pci_irq, cyz_interrupt,
SA_SHIRQ, "Cyclades-Z", &cy_card[j]))
{
printk("Cyclom-Ze/PCI found at 0x%lx ",
(ulong) cy_pci_phys2);
printk("but could not allocate IRQ%d.n",
cy_pci_irq);
return(i);
}
}
#endif /* CONFIG_CYZ_INTR */
/* set cy_card */
cy_card[j].base_phys = cy_pci_phys2;
cy_card[j].ctl_phys = cy_pci_phys0;
cy_card[j].base_addr = cy_pci_addr2;
cy_card[j].ctl_addr = cy_pci_addr0;
cy_card[j].irq = (int) cy_pci_irq;
cy_card[j].bus_index = 1;
cy_card[j].first_line = cy_next_channel;
cy_card[j].num_chips = -1;
/* print message */
#ifdef CONFIG_CYZ_INTR
/* don't report IRQ if board is no IRQ */
if( (cy_pci_irq != 0) && (cy_pci_irq != 255) )
printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, IRQ%d, ",
j+1,(ulong)cy_pci_phys2,
(ulong)(cy_pci_phys2 + CyPCI_Ze_win - 1),
(int)cy_pci_irq);
else
#endif /* CONFIG_CYZ_INTR */
printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, ",
j+1,(ulong)cy_pci_phys2,
(ulong)(cy_pci_phys2 + CyPCI_Ze_win - 1));
printk("%d channels starting from port %d.n",
cy_pci_nchan,cy_next_channel);
cy_next_channel += cy_pci_nchan;
}
if (ZeIndex != 0) {
printk("Cyclades-Ze/PCI found at 0x%x ",
(unsigned int) Ze_phys2[0]);
printk("but no more cards can be used.n");
printk("Change NR_CARDS in cyclades.c and recompile kernel.n");
}
return(i);
#else
return(0);
#endif /* ifdef CONFIG_PCI */
} /* cy_detect_pci */
/*
* This routine prints out the appropriate serial driver version number
* and identifies which options were configured into this driver.
*/
static inline void
show_version(void)
{
char *rcsvers, *rcsdate, *tmp;
rcsvers = strchr(rcsid, ' '); rcsvers++;
tmp = strchr(rcsvers, ' '); *tmp++ = '';
rcsdate = strchr(tmp, ' '); rcsdate++;
tmp = strrchr(rcsdate, ' '); *tmp = '';
printk("Cyclades driver %s %sn",
rcsvers, rcsdate);
printk(" built %s %sn",
__DATE__, __TIME__);
} /* show_version */
static int
cyclades_get_proc_info(char *buf, char **start, off_t offset, int length,
int *eof, void *data)
{
struct cyclades_port *info;
int i;
int len=0;
off_t begin=0;
off_t pos=0;
int size;
__u32 cur_jifs = jiffies;
size = sprintf(buf, "Dev TimeOpen BytesOut IdleOut BytesIn IdleIn Overruns Ldiscn");
pos += size;
len += size;
/* Output one line for each known port */
for (i = 0; i < NR_PORTS && cy_port[i].line >= 0; i++) {
info = &cy_port[i];
if (info->count)
size = sprintf(buf+len,
"%3d %8lu %10lu %8lu %10lu %8lu %9lu %6ldn",
info->line,
JIFFIES_DIFF(info->idle_stats.in_use, cur_jifs) / HZ,
info->idle_stats.xmit_bytes,
JIFFIES_DIFF(info->idle_stats.xmit_idle, cur_jifs) / HZ,
info->idle_stats.recv_bytes,
JIFFIES_DIFF(info->idle_stats.recv_idle, cur_jifs) / HZ,
info->idle_stats.overruns,
(long) info->tty->ldisc.num);
else
size = sprintf(buf+len,
"%3d %8lu %10lu %8lu %10lu %8lu %9lu %6ldn",
info->line, 0L, 0L, 0L, 0L, 0L, 0L, 0L);
len += size;
pos = begin + len;
if (pos < offset) {
len = 0;
begin = pos;
}
if (pos > offset + length)
goto done;
}
*eof = 1;
done:
*start = buf + (offset - begin); /* Start of wanted data */
len -= (offset - begin); /* Start slop */
if (len > length)
len = length; /* Ending slop */
if (len < 0)
len = 0;
return len;
}
/* The serial driver boot-time initialization code!
Hardware I/O ports are mapped to character special devices on a
first found, first allocated manner. That is, this code searches
for Cyclom cards in the system. As each is found, it is probed
to discover how many chips (and thus how many ports) are present.
These ports are mapped to the tty ports 32 and upward in monotonic
fashion. If an 8-port card is replaced with a 16-port card, the
port mapping on a following card will shift.
This approach is different from what is used in the other serial
device driver because the Cyclom is more properly a multiplexer,
not just an aggregation of serial ports on one card.
If there are more cards with more ports than have been
statically allocated above, a warning is printed and the
extra ports are ignored.
*/
int __init
cy_init(void)
{
struct cyclades_port *info;
struct cyclades_card *cinfo;
int number_z_boards = 0;
int board,port,i,index;
unsigned long mailbox;
unsigned short chip_number;
int nports;
init_bh(CYCLADES_BH, do_cyclades_bh);
show_version();
/* Initialize the tty_driver structure */
memset(&cy_serial_driver, 0, sizeof(struct tty_driver));
cy_serial_driver.magic = TTY_DRIVER_MAGIC;
cy_serial_driver.driver_name = "cyclades";
cy_serial_driver.name = "ttyC";
cy_serial_driver.major = CYCLADES_MAJOR;
cy_serial_driver.minor_start = 0;
cy_serial_driver.num = NR_PORTS;
cy_serial_driver.type = TTY_DRIVER_TYPE_SERIAL;
cy_serial_driver.subtype = SERIAL_TYPE_NORMAL;
cy_serial_driver.init_termios = tty_std_termios;
cy_serial_driver.init_termios.c_cflag =
B9600 | CS8 | CREAD | HUPCL | CLOCAL;
cy_serial_driver.flags = TTY_DRIVER_REAL_RAW;
cy_serial_driver.refcount = &serial_refcount;
cy_serial_driver.table = serial_table;
cy_serial_driver.termios = serial_termios;
cy_serial_driver.termios_locked = serial_termios_locked;
cy_serial_driver.open = cy_open;
cy_serial_driver.close = cy_close;
cy_serial_driver.write = cy_write;
cy_serial_driver.put_char = cy_put_char;
cy_serial_driver.flush_chars = cy_flush_chars;
cy_serial_driver.write_room = cy_write_room;
cy_serial_driver.chars_in_buffer = cy_chars_in_buffer;
cy_serial_driver.flush_buffer = cy_flush_buffer;
cy_serial_driver.ioctl = cy_ioctl;
cy_serial_driver.throttle = cy_throttle;
cy_serial_driver.unthrottle = cy_unthrottle;
cy_serial_driver.set_termios = cy_set_termios;
cy_serial_driver.stop = cy_stop;
cy_serial_driver.start = cy_start;
cy_serial_driver.hangup = cy_hangup;
cy_serial_driver.break_ctl = cy_break;
cy_serial_driver.wait_until_sent = cy_wait_until_sent;
cy_serial_driver.read_proc = cyclades_get_proc_info;
/*
* The callout device is just like normal device except for
* major number and the subtype code.
*/
cy_callout_driver = cy_serial_driver;
cy_callout_driver.name = "cub";
cy_callout_driver.major = CYCLADESAUX_MAJOR;
cy_callout_driver.subtype = SERIAL_TYPE_CALLOUT;
cy_callout_driver.read_proc = 0;
cy_callout_driver.proc_entry = 0;
if (tty_register_driver(&cy_serial_driver))
panic("Couldn't register Cyclades serial drivern");
if (tty_register_driver(&cy_callout_driver))
panic("Couldn't register Cyclades callout drivern");
for (i = 0; i < NR_CARDS; i++) {
/* base_addr=0 indicates board not found */
cy_card[i].base_addr = 0;
}
/* the code below is responsible to find the boards. Each different
type of board has its own detection routine. If a board is found,
the next cy_card structure available is set by the detection
routine. These functions are responsible for checking the
availability of cy_card and cy_port data structures and updating
the cy_next_channel. */
/* look for isa boards */
cy_isa_nboard = cy_detect_isa();
/* look for pci boards */
cy_pci_nboard = cy_detect_pci();
cy_nboard = cy_isa_nboard + cy_pci_nboard;
/* invalidate remaining cy_card structures */
for (i = 0 ; i < NR_CARDS ; i++) {
if (cy_card[i].base_addr == 0) {
cy_card[i].first_line = -1;
cy_card[i].ctl_addr = 0;
cy_card[i].irq = 0;
cy_card[i].bus_index = 0;
cy_card[i].first_line = 0;
cy_card[i].num_chips = 0;
}
}
/* invalidate remaining cy_port structures */
for (i = cy_next_channel ; i < NR_PORTS ; i++) {
cy_port[i].line = -1;
cy_port[i].magic = -1;
}
/* initialize per-port data structures for each valid board found */
for (board = 0 ; board < cy_nboard ; board++) {
cinfo = &cy_card[board];
if (cinfo->num_chips == -1) { /* Cyclades-Z */
number_z_boards++;
mailbox = cy_readl(&((struct RUNTIME_9060 *)
cy_card[board].ctl_addr)->mail_box_0);
nports = (mailbox == ZE_V1) ? ZE_V1_NPORTS : 8;
cinfo->intr_enabled = 0;
cinfo->nports = 0; /* Will be correctly set later, after
Z FW is loaded */
spin_lock_init(&cinfo->card_lock);
for (port = cinfo->first_line ;
port < cinfo->first_line + nports;
port++)
{
info = &cy_port[port];
info->magic = CYCLADES_MAGIC;
info->type = PORT_STARTECH;
info->card = board;
info->line = port;
info->chip_rev = 0;
info->flags = STD_COM_FLAGS;
info->tty = 0;
if (mailbox == ZO_V1)
info->xmit_fifo_size = CYZ_FIFO_SIZE;
else
info->xmit_fifo_size = 4 * CYZ_FIFO_SIZE;
info->cor1 = 0;
info->cor2 = 0;
info->cor3 = 0;
info->cor4 = 0;
info->cor5 = 0;
info->tbpr = 0;
info->tco = 0;
info->rbpr = 0;
info->rco = 0;
info->custom_divisor = 0;
info->close_delay = 5*HZ/10;
info->closing_wait = CLOSING_WAIT_DELAY;
info->icount.cts = info->icount.dsr =
info->icount.rng = info->icount.dcd = 0;
info->icount.rx = info->icount.tx = 0;
info->icount.frame = info->icount.parity = 0;
info->icount.overrun = info->icount.brk = 0;
info->x_char = 0;
info->event = 0;
info->count = 0;
info->blocked_open = 0;
info->default_threshold = 0;
info->default_timeout = 0;
info->tqueue.routine = do_softint;
info->tqueue.data = info;
info->callout_termios =
cy_callout_driver.init_termios;
info->normal_termios =
cy_serial_driver.init_termios;
init_waitqueue_head(&info->open_wait);
init_waitqueue_head(&info->close_wait);
init_waitqueue_head(&info->shutdown_wait);
init_waitqueue_head(&info->delta_msr_wait);
/* info->session */
/* info->pgrp */
info->read_status_mask = 0;
/* info->timeout */
/* Bentson's vars */
info->jiffies[0] = 0;
info->jiffies[1] = 0;
info->jiffies[2] = 0;
info->rflush_count = 0;
#ifdef CONFIG_CYZ_INTR
cyz_rx_full_timer[port].function = NULL;
#endif
}
continue;
}else{ /* Cyclom-Y of some kind*/
index = cinfo->bus_index;
spin_lock_init(&cinfo->card_lock);
cinfo->nports = CyPORTS_PER_CHIP * cinfo->num_chips;
for (port = cinfo->first_line ;
port < cinfo->first_line + cinfo->nports ;
port++)
{
info = &cy_port[port];
info->magic = CYCLADES_MAGIC;
info->type = PORT_CIRRUS;
info->card = board;
info->line = port;
info->flags = STD_COM_FLAGS;
info->tty = 0;
info->xmit_fifo_size = CyMAX_CHAR_FIFO;
info->cor1 = CyPARITY_NONE|Cy_1_STOP|Cy_8_BITS;
info->cor2 = CyETC;
info->cor3 = 0x08; /* _very_ small rcv threshold */
info->cor4 = 0;
info->cor5 = 0;
info->custom_divisor = 0;
info->close_delay = 5*HZ/10;
info->closing_wait = CLOSING_WAIT_DELAY;
info->icount.cts = info->icount.dsr =
info->icount.rng = info->icount.dcd = 0;
info->icount.rx = info->icount.tx = 0;
info->icount.frame = info->icount.parity = 0;
info->icount.overrun = info->icount.brk = 0;
chip_number = (port - cinfo->first_line) / 4;
if ((info->chip_rev =
cy_readb(cinfo->base_addr +
(cy_chip_offset[chip_number]<<index) +
(CyGFRCR<<index))) >= CD1400_REV_J) {
/* It is a CD1400 rev. J or later */
info->tbpr = baud_bpr_60[13]; /* Tx BPR */
info->tco = baud_co_60[13]; /* Tx CO */
info->rbpr = baud_bpr_60[13]; /* Rx BPR */
info->rco = baud_co_60[13]; /* Rx CO */
info->rflow = 0;
info->rtsdtr_inv = 1;
} else {
info->tbpr = baud_bpr_25[13]; /* Tx BPR */
info->tco = baud_co_25[13]; /* Tx CO */
info->rbpr = baud_bpr_25[13]; /* Rx BPR */
info->rco = baud_co_25[13]; /* Rx CO */
info->rflow = 0;
info->rtsdtr_inv = 0;
}
info->x_char = 0;
info->event = 0;
info->count = 0;
info->blocked_open = 0;
info->default_threshold = 0;
info->default_timeout = 0;
info->tqueue.routine = do_softint;
info->tqueue.data = info;
info->callout_termios =
cy_callout_driver.init_termios;
info->normal_termios =
cy_serial_driver.init_termios;
init_waitqueue_head(&info->open_wait);
init_waitqueue_head(&info->close_wait);
init_waitqueue_head(&info->shutdown_wait);
init_waitqueue_head(&info->delta_msr_wait);
/* info->session */
/* info->pgrp */
info->read_status_mask =
CyTIMEOUT| CySPECHAR| CyBREAK
| CyPARITY| CyFRAME| CyOVERRUN;
/* info->timeout */
}
}
}
#ifndef CONFIG_CYZ_INTR
if (number_z_boards && !cyz_timeron){
cyz_timeron++;
cyz_timerlist.expires = jiffies + 1;
add_timer(&cyz_timerlist);
#ifdef CY_PCI_DEBUG
printk("Cyclades-Z polling initializedn");
#endif
}
#endif /* CONFIG_CYZ_INTR */
return 0;
} /* cy_init */
#ifdef MODULE
void
cy_cleanup_module(void)
{
int i;
int e1, e2;
unsigned long flags;
#ifndef CONFIG_CYZ_INTR
if (cyz_timeron){
cyz_timeron = 0;
del_timer(&cyz_timerlist);
}
#endif /* CONFIG_CYZ_INTR */
save_flags(flags); cli();
remove_bh(CYCLADES_BH);
if ((e1 = tty_unregister_driver(&cy_serial_driver)))
printk("cyc: failed to unregister Cyclades serial driver(%d)n",
e1);
if ((e2 = tty_unregister_driver(&cy_callout_driver)))
printk("cyc: failed to unregister Cyclades callout driver (%d)n",
e2);
restore_flags(flags);
for (i = 0; i < NR_CARDS; i++) {
if (cy_card[i].base_addr != 0) {
iounmap((void *)cy_card[i].base_addr);
if (cy_card[i].ctl_addr != 0)
iounmap((void *)cy_card[i].ctl_addr);
if (cy_card[i].irq
#ifndef CONFIG_CYZ_INTR
&& cy_card[i].num_chips != -1 /* not a Z card */
#endif /* CONFIG_CYZ_INTR */
)
free_irq(cy_card[i].irq, &cy_card[i]);
if (cy_card[i].resource) {
cy_card[i].resource = NULL;
release_region(cy_card[i].res_start, cy_card[i].res_len);
}
}
}
if (tmp_buf) {
free_page((unsigned long) tmp_buf);
tmp_buf = NULL;
}
} /* cy_cleanup_module */
/* Module entry-points */
module_init(cy_init);
module_exit(cy_cleanup_module);
#else /* MODULE */
/* called by linux/init/main.c to parse command line options */
void
cy_setup(char *str, int *ints)
{
#ifdef CONFIG_ISA
int i, j;
for (i = 0 ; i < NR_ISA_ADDRS ; i++) {
if (cy_isa_addresses[i] == 0) break;
}
for (j = 1; j <= ints[0]; j++){
if ( i < NR_ISA_ADDRS ){
cy_isa_addresses[i++] = (unsigned char *)(ints[j]);
}
}
#endif /* CONFIG_ISA */
} /* cy_setup */
#endif /* MODULE */
MODULE_LICENSE("GPL");