|
@@ -286,8 +286,6 @@ struct mxser_mstatus {
|
|
|
int dcd;
|
|
|
};
|
|
|
|
|
|
-static struct mxser_mstatus GMStatus[MXSER_PORTS];
|
|
|
-
|
|
|
static int mxserBoardCAP[MXSER_BOARDS] = {
|
|
|
0, 0, 0, 0
|
|
|
/* 0x180, 0x280, 0x200, 0x320 */
|
|
@@ -296,9 +294,6 @@ static int mxserBoardCAP[MXSER_BOARDS] = {
|
|
|
static struct mxser_board mxser_boards[MXSER_BOARDS];
|
|
|
static struct tty_driver *mxvar_sdriver;
|
|
|
static struct mxser_log mxvar_log;
|
|
|
-static int mxvar_diagflag;
|
|
|
-static unsigned char mxser_msr[MXSER_PORTS + 1];
|
|
|
-static struct mxser_mon_ext mon_data_ext;
|
|
|
static int mxser_set_baud_method[MXSER_PORTS + 1];
|
|
|
|
|
|
static void mxser_enable_must_enchance_mode(unsigned long baseio)
|
|
@@ -542,6 +537,7 @@ static void process_txrx_fifo(struct mxser_port *info)
|
|
|
|
|
|
static unsigned char mxser_get_msr(int baseaddr, int mode, int port)
|
|
|
{
|
|
|
+ static unsigned char mxser_msr[MXSER_PORTS + 1];
|
|
|
unsigned char status = 0;
|
|
|
|
|
|
status = inb(baseaddr + UART_MSR);
|
|
@@ -1652,62 +1648,60 @@ static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
|
|
|
ret = -EFAULT;
|
|
|
unlock_kernel();
|
|
|
return ret;
|
|
|
- case MOXA_GETMSTATUS:
|
|
|
+ case MOXA_GETMSTATUS: {
|
|
|
+ struct mxser_mstatus ms, __user *msu = argp;
|
|
|
lock_kernel();
|
|
|
for (i = 0; i < MXSER_BOARDS; i++)
|
|
|
for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
|
|
|
port = &mxser_boards[i].ports[j];
|
|
|
+ memset(&ms, 0, sizeof(ms));
|
|
|
|
|
|
- GMStatus[i].ri = 0;
|
|
|
- if (!port->ioaddr) {
|
|
|
- GMStatus[i].dcd = 0;
|
|
|
- GMStatus[i].dsr = 0;
|
|
|
- GMStatus[i].cts = 0;
|
|
|
- continue;
|
|
|
- }
|
|
|
+ if (!port->ioaddr)
|
|
|
+ goto copy;
|
|
|
|
|
|
if (!port->port.tty || !port->port.tty->termios)
|
|
|
- GMStatus[i].cflag =
|
|
|
- port->normal_termios.c_cflag;
|
|
|
+ ms.cflag = port->normal_termios.c_cflag;
|
|
|
else
|
|
|
- GMStatus[i].cflag =
|
|
|
- port->port.tty->termios->c_cflag;
|
|
|
+ ms.cflag = port->port.tty->termios->c_cflag;
|
|
|
|
|
|
status = inb(port->ioaddr + UART_MSR);
|
|
|
- if (status & 0x80 /*UART_MSR_DCD */ )
|
|
|
- GMStatus[i].dcd = 1;
|
|
|
- else
|
|
|
- GMStatus[i].dcd = 0;
|
|
|
-
|
|
|
- if (status & 0x20 /*UART_MSR_DSR */ )
|
|
|
- GMStatus[i].dsr = 1;
|
|
|
- else
|
|
|
- GMStatus[i].dsr = 0;
|
|
|
-
|
|
|
-
|
|
|
- if (status & 0x10 /*UART_MSR_CTS */ )
|
|
|
- GMStatus[i].cts = 1;
|
|
|
- else
|
|
|
- GMStatus[i].cts = 0;
|
|
|
+ if (status & UART_MSR_DCD)
|
|
|
+ ms.dcd = 1;
|
|
|
+ if (status & UART_MSR_DSR)
|
|
|
+ ms.dsr = 1;
|
|
|
+ if (status & UART_MSR_CTS)
|
|
|
+ ms.cts = 1;
|
|
|
+ copy:
|
|
|
+ if (copy_to_user(msu, &ms, sizeof(ms))) {
|
|
|
+ unlock_kernel();
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ msu++;
|
|
|
}
|
|
|
unlock_kernel();
|
|
|
- if (copy_to_user(argp, GMStatus,
|
|
|
- sizeof(struct mxser_mstatus) * MXSER_PORTS))
|
|
|
- return -EFAULT;
|
|
|
return 0;
|
|
|
+ }
|
|
|
case MOXA_ASPP_MON_EXT: {
|
|
|
- int p, shiftbit;
|
|
|
- unsigned long opmode;
|
|
|
- unsigned cflag, iflag;
|
|
|
+ struct mxser_mon_ext *me; /* it's 2k, stack unfriendly */
|
|
|
+ unsigned int cflag, iflag, p;
|
|
|
+ u8 opmode;
|
|
|
+
|
|
|
+ me = kzalloc(sizeof(*me), GFP_KERNEL);
|
|
|
+ if (!me)
|
|
|
+ return -ENOMEM;
|
|
|
|
|
|
lock_kernel();
|
|
|
- for (i = 0; i < MXSER_BOARDS; i++) {
|
|
|
- for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
|
|
|
+ for (i = 0, p = 0; i < MXSER_BOARDS; i++) {
|
|
|
+ for (j = 0; j < MXSER_PORTS_PER_BOARD; j++, p++) {
|
|
|
+ if (p >= ARRAY_SIZE(me->rx_cnt)) {
|
|
|
+ i = MXSER_BOARDS;
|
|
|
+ break;
|
|
|
+ }
|
|
|
port = &mxser_boards[i].ports[j];
|
|
|
if (!port->ioaddr)
|
|
|
continue;
|
|
|
|
|
|
- status = mxser_get_msr(port->ioaddr, 0, i);
|
|
|
+ status = mxser_get_msr(port->ioaddr, 0, p);
|
|
|
|
|
|
if (status & UART_MSR_TERI)
|
|
|
port->icount.rng++;
|
|
@@ -1719,16 +1713,13 @@ static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
|
|
|
port->icount.cts++;
|
|
|
|
|
|
port->mon_data.modem_status = status;
|
|
|
- mon_data_ext.rx_cnt[i] = port->mon_data.rxcnt;
|
|
|
- mon_data_ext.tx_cnt[i] = port->mon_data.txcnt;
|
|
|
- mon_data_ext.up_rxcnt[i] =
|
|
|
- port->mon_data.up_rxcnt;
|
|
|
- mon_data_ext.up_txcnt[i] =
|
|
|
- port->mon_data.up_txcnt;
|
|
|
- mon_data_ext.modem_status[i] =
|
|
|
+ me->rx_cnt[p] = port->mon_data.rxcnt;
|
|
|
+ me->tx_cnt[p] = port->mon_data.txcnt;
|
|
|
+ me->up_rxcnt[p] = port->mon_data.up_rxcnt;
|
|
|
+ me->up_txcnt[p] = port->mon_data.up_txcnt;
|
|
|
+ me->modem_status[p] =
|
|
|
port->mon_data.modem_status;
|
|
|
- mon_data_ext.baudrate[i] =
|
|
|
- tty_get_baud_rate(port->port.tty);
|
|
|
+ me->baudrate[p] = tty_get_baud_rate(port->port.tty);
|
|
|
|
|
|
if (!port->port.tty || !port->port.tty->termios) {
|
|
|
cflag = port->normal_termios.c_cflag;
|
|
@@ -1738,40 +1729,31 @@ static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
|
|
|
iflag = port->port.tty->termios->c_iflag;
|
|
|
}
|
|
|
|
|
|
- mon_data_ext.databits[i] = cflag & CSIZE;
|
|
|
-
|
|
|
- mon_data_ext.stopbits[i] = cflag & CSTOPB;
|
|
|
-
|
|
|
- mon_data_ext.parity[i] =
|
|
|
- cflag & (PARENB | PARODD | CMSPAR);
|
|
|
-
|
|
|
- mon_data_ext.flowctrl[i] = 0x00;
|
|
|
+ me->databits[p] = cflag & CSIZE;
|
|
|
+ me->stopbits[p] = cflag & CSTOPB;
|
|
|
+ me->parity[p] = cflag & (PARENB | PARODD |
|
|
|
+ CMSPAR);
|
|
|
|
|
|
if (cflag & CRTSCTS)
|
|
|
- mon_data_ext.flowctrl[i] |= 0x03;
|
|
|
+ me->flowctrl[p] |= 0x03;
|
|
|
|
|
|
if (iflag & (IXON | IXOFF))
|
|
|
- mon_data_ext.flowctrl[i] |= 0x0C;
|
|
|
+ me->flowctrl[p] |= 0x0C;
|
|
|
|
|
|
if (port->type == PORT_16550A)
|
|
|
- mon_data_ext.fifo[i] = 1;
|
|
|
- else
|
|
|
- mon_data_ext.fifo[i] = 0;
|
|
|
+ me->fifo[p] = 1;
|
|
|
|
|
|
- p = i % 4;
|
|
|
- shiftbit = p * 2;
|
|
|
- opmode = inb(port->opmode_ioaddr) >> shiftbit;
|
|
|
+ opmode = inb(port->opmode_ioaddr) >>
|
|
|
+ ((p % 4) * 2);
|
|
|
opmode &= OP_MODE_MASK;
|
|
|
-
|
|
|
- mon_data_ext.iftype[i] = opmode;
|
|
|
-
|
|
|
+ me->iftype[p] = opmode;
|
|
|
}
|
|
|
}
|
|
|
unlock_kernel();
|
|
|
- if (copy_to_user(argp, &mon_data_ext,
|
|
|
- sizeof(mon_data_ext)))
|
|
|
- return -EFAULT;
|
|
|
- return 0;
|
|
|
+ if (copy_to_user(argp, me, sizeof(*me)))
|
|
|
+ ret = -EFAULT;
|
|
|
+ kfree(me);
|
|
|
+ return ret;
|
|
|
}
|
|
|
default:
|
|
|
return -ENOIOCTLCMD;
|
|
@@ -2802,8 +2784,6 @@ static int __init mxser_module_init(void)
|
|
|
goto err_put;
|
|
|
}
|
|
|
|
|
|
- mxvar_diagflag = 0;
|
|
|
-
|
|
|
m = 0;
|
|
|
/* Start finding ISA boards here */
|
|
|
for (isaloop = 0; isaloop < 2; isaloop++)
|