atp870u: Untangle tmpcip

Untangle the tmpcip crap so it becomes obvious what ports are accessed.

Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
This commit is contained in:
Ondrej Zary 2015-11-17 19:23:47 +01:00 committed by Martin K. Petersen
parent e2c22b45cb
commit bc0fe4c91c

View File

@ -47,7 +47,7 @@ static void tscam_885(void);
static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
{
unsigned long flags;
unsigned short int tmpcip, id;
unsigned short int id;
unsigned char i, j, c, target_id, lun,cmdp;
unsigned char *prd;
struct scsi_cmnd *workreq;
@ -79,30 +79,24 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
if ((inb(dev->ioport[c] + 0x16) & 0x80) == 0)
outb((inb(dev->ioport[c] + 0x16) | 0x80), dev->ioport[c] + 0x16);
}
tmpcip = dev->pciport[c];
if ((inb(tmpcip) & 0x08) != 0)
if ((inb(dev->pciport[c]) & 0x08) != 0)
{
tmpcip += 0x2;
for (k=0; k < 1000; k++) {
if ((inb(tmpcip) & 0x08) == 0) {
if ((inb(dev->pciport[c] + 2) & 0x08) == 0) {
goto stop_dma;
}
if ((inb(tmpcip) & 0x01) == 0) {
if ((inb(dev->pciport[c] + 2) & 0x01) == 0) {
goto stop_dma;
}
}
}
stop_dma:
tmpcip = dev->pciport[c];
outb(0x00, tmpcip);
outb(0x00, dev->pciport[c]);
i = inb(dev->ioport[c] + 0x17);
if (dev->dev_id == ATP885_DEVID) {
tmpcip += 2;
outb(0x06, tmpcip);
tmpcip -= 2;
}
if (dev->dev_id == ATP885_DEVID)
outb(0x06, dev->pciport[c] + 2);
target_id = inb(dev->ioport[c] + 0x15);
@ -303,13 +297,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
/* enable 32 bit fifo transfer */
if (dev->dev_id == ATP885_DEVID) {
tmpcip = dev->pciport[c] + 1;
i=inb(tmpcip) & 0xf3;
i=inb(dev->pciport[c] + 1) & 0xf3;
//j=workreq->cmnd[0];
if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
i |= 0x0c;
}
outb(i,tmpcip);
outb(i, dev->pciport[c] + 1);
} else if ((dev->dev_id == ATP880_DEVID1) ||
(dev->dev_id == ATP880_DEVID2) ) {
if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
@ -371,25 +364,20 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
}
}
}
tmpcip = dev->pciport[c] + 0x04;
outl(dev->id[c][target_id].prdaddr, tmpcip);
outl(dev->id[c][target_id].prdaddr, dev->pciport[c] + 0x04);
#ifdef ED_DBGP
printk("dev->id[%d][%d].prdaddr 0x%8x\n", c, target_id, dev->id[c][target_id].prdaddr);
#endif
if (dev->dev_id == ATP885_DEVID) {
tmpcip -= 0x04;
} else {
tmpcip -= 0x02;
outb(0x06, tmpcip);
outb(0x00, tmpcip);
tmpcip -= 0x02;
if (dev->dev_id != ATP885_DEVID) {
outb(0x06, dev->pciport[c] + 2);
outb(0x00, dev->pciport[c] + 2);
}
/*
* Check transfer direction
*/
if (dev->id[c][target_id].dirct != 0) {
outb(0x08, dev->ioport[c] + 0x18);
outb(0x01, tmpcip);
outb(0x01, dev->pciport[c]);
dev->in_int[c] = 0;
#ifdef ED_DBGP
printk("status 0x80 return dirct != 0\n");
@ -397,7 +385,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
goto handled;
}
outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, tmpcip);
outb(0x09, dev->pciport[c]);
dev->in_int[c] = 0;
#ifdef ED_DBGP
printk("status 0x80 return dirct = 0\n");
@ -484,12 +472,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
}
i &= 0x0f;
if (i == 0x09) {
tmpcip += 4;
outl(dev->id[c][target_id].prdaddr, tmpcip);
tmpcip = tmpcip - 2;
outb(0x06, tmpcip);
outb(0x00, tmpcip);
tmpcip = tmpcip - 2;
outl(dev->id[c][target_id].prdaddr, dev->pciport[c] + 4);
outb(0x06, dev->pciport[c] + 2);
outb(0x00, dev->pciport[c] + 2);
outb(0x41, dev->ioport[c] + 0x10);
if (dev->dev_id == ATP885_DEVID) {
k = dev->id[c][target_id].last_len;
@ -501,17 +486,14 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
dev->id[c][target_id].dirct = 0x00;
}
outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, tmpcip);
outb(0x09, dev->pciport[c]);
dev->in_int[c] = 0;
goto handled;
}
if (i == 0x08) {
tmpcip += 4;
outl(dev->id[c][target_id].prdaddr, tmpcip);
tmpcip = tmpcip - 2;
outb(0x06, tmpcip);
outb(0x00, tmpcip);
tmpcip = tmpcip - 2;
outl(dev->id[c][target_id].prdaddr, dev->pciport[c] + 4);
outb(0x06, dev->pciport[c] + 2);
outb(0x00, dev->pciport[c] + 2);
outb(0x41, dev->ioport[c] + 0x10);
if (dev->dev_id == ATP885_DEVID) {
k = dev->id[c][target_id].last_len;
@ -522,7 +504,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb((unsigned char) (inb(dev->ioport[c] + 0x15) | 0x20), dev->ioport[c] + 0x15);
dev->id[c][target_id].dirct = 0x20;
outb(0x08, dev->ioport[c] + 0x18);
outb(0x01, tmpcip);
outb(0x01, dev->pciport[c]);
dev->in_int[c] = 0;
goto handled;
}