diff options
| author | Jens Taprogge <jens.taprogge@taprogge.org> | 2012-09-12 14:55:29 +0200 |
|---|---|---|
| committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2012-09-12 09:54:15 -0700 |
| commit | 4e4732aca9679c1ec70c7a287bf04563e792923c (patch) | |
| tree | c7c602938eb2a09cb7f381f3920b8d80fd7a195f /drivers/staging/ipack | |
| parent | ef79de031437ead308093289604eeb3b5b9d924f (diff) | |
Staging: ipack/devices/ipoctal: Store isr masks in ipoctal_channel
This way interrupt handling becomes independent of the channel number.
Signed-off-by: Jens Taprogge <jens.taprogge@taprogge.org>
Signed-off-by: Samuel Iglesias Gonsalvez <siglesias@igalia.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
Diffstat (limited to 'drivers/staging/ipack')
| -rw-r--r-- | drivers/staging/ipack/devices/ipoctal.c | 22 |
1 files changed, 11 insertions, 11 deletions
diff --git a/drivers/staging/ipack/devices/ipoctal.c b/drivers/staging/ipack/devices/ipoctal.c index 70dc7a236d49..56e810b78ee3 100644 --- a/drivers/staging/ipack/devices/ipoctal.c +++ b/drivers/staging/ipack/devices/ipoctal.c @@ -44,6 +44,8 @@ struct ipoctal_channel { union scc2698_block __iomem *block_regs; unsigned int board_id; unsigned char *board_write; + u8 isr_rx_rdy_mask; + u8 isr_tx_rdy_mask; }; struct ipoctal { @@ -166,7 +168,6 @@ static int ipoctal_irq_handler(void *arg) unsigned int ichannel; unsigned char isr; unsigned char sr; - unsigned char isr_tx_rdy, isr_rx_rdy; unsigned char value; unsigned char flag; struct tty_struct *tty; @@ -191,14 +192,6 @@ static int ipoctal_irq_handler(void *arg) isr = ioread8(&channel->block_regs->r.isr); sr = ioread8(&channel->regs->r.sr); - if ((ichannel % 2) == 1) { - isr_tx_rdy = isr & ISR_TxRDY_B; - isr_rx_rdy = isr & ISR_RxRDY_FFULL_B; - } else { - isr_tx_rdy = isr & ISR_TxRDY_A; - isr_rx_rdy = isr & ISR_RxRDY_FFULL_A; - } - /* In case of RS-485, change from TX to RX when finishing TX. * Half-duplex. */ @@ -213,7 +206,7 @@ static int ipoctal_irq_handler(void *arg) } /* RX data */ - if (isr_rx_rdy && (sr & SR_RX_READY)) { + if ((isr && channel->isr_rx_rdy_mask) && (sr & SR_RX_READY)) { value = ioread8(&channel->regs->r.rhr); flag = TTY_NORMAL; @@ -244,7 +237,7 @@ static int ipoctal_irq_handler(void *arg) } /* TX of each character */ - if (isr_tx_rdy && (sr & SR_TX_READY)) { + if ((isr & channel->isr_tx_rdy_mask) && (sr & SR_TX_READY)) { unsigned int *pointer_write = &channel->pointer_write; if (channel->nb_bytes <= 0) { @@ -365,6 +358,13 @@ static int ipoctal_inst_slot(struct ipoctal *ipoctal, unsigned int bus_nr, channel->block_regs = block_regs + (i >> 1); channel->board_write = &ipoctal->write; channel->board_id = ipoctal->board_id; + if (i & 1) { + channel->isr_tx_rdy_mask = ISR_TxRDY_B; + channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_B; + } else { + channel->isr_tx_rdy_mask = ISR_TxRDY_A; + channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_A; + } iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr); iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr); |