forked from luck/tmp_suning_uos_patched
atp870u: Untangle tmport
Untangle the tmport 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
Martin K. Petersen
parent
b4263b3ce9
commit
3a38e53ee6
|
|
@ -51,7 +51,6 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
unsigned char i, j, c, target_id, lun,cmdp;
|
||||
unsigned char *prd;
|
||||
struct scsi_cmnd *workreq;
|
||||
unsigned int tmport;
|
||||
unsigned long adrcnt, k;
|
||||
#ifdef ED_DBGP
|
||||
unsigned long l;
|
||||
|
|
@ -61,8 +60,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
|
||||
|
||||
for (c = 0; c < 2; c++) {
|
||||
tmport = dev->ioport[c] + 0x1f;
|
||||
j = inb(tmport);
|
||||
j = inb(dev->ioport[c] + 0x1f);
|
||||
if ((j & 0x80) != 0)
|
||||
{
|
||||
goto ch_sel;
|
||||
|
|
@ -97,9 +95,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
stop_dma:
|
||||
tmpcip = dev->pciport[c];
|
||||
outb(0x00, tmpcip);
|
||||
tmport -= 0x08;
|
||||
|
||||
i = inb(tmport);
|
||||
i = inb(dev->ioport[c] + 0x17);
|
||||
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
tmpcip += 2;
|
||||
|
|
@ -107,9 +104,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
tmpcip -= 2;
|
||||
}
|
||||
|
||||
tmport -= 0x02;
|
||||
target_id = inb(tmport);
|
||||
tmport += 0x02;
|
||||
target_id = inb(dev->ioport[c] + 0x15);
|
||||
|
||||
/*
|
||||
* Remap wide devices onto id numbers
|
||||
|
|
@ -137,11 +132,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
dev->last_cmd[c] = 0xff;
|
||||
}
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
tmport -= 0x05;
|
||||
adrcnt = 0;
|
||||
((unsigned char *) &adrcnt)[2] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[1] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[0] = inb(tmport);
|
||||
((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
|
||||
((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
|
||||
((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
|
||||
if (dev->id[c][target_id].last_len != adrcnt)
|
||||
{
|
||||
k = dev->id[c][target_id].last_len;
|
||||
|
|
@ -150,7 +144,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
dev->id[c][target_id].last_len = adrcnt;
|
||||
}
|
||||
#ifdef ED_DBGP
|
||||
printk("tmport = %x dev->id[c][target_id].last_len = %d dev->id[c][target_id].tran_len = %d\n",tmport,dev->id[c][target_id].last_len,dev->id[c][target_id].tran_len);
|
||||
printk("dev->id[c][target_id].last_len = %d dev->id[c][target_id].tran_len = %d\n",dev->id[c][target_id].last_len,dev->id[c][target_id].tran_len);
|
||||
#endif
|
||||
}
|
||||
|
||||
|
|
@ -158,10 +152,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
* Flip wide
|
||||
*/
|
||||
if (dev->wide_id[c] != 0) {
|
||||
tmport = dev->ioport[c] + 0x1b;
|
||||
outb(0x01, tmport);
|
||||
while ((inb(tmport) & 0x01) != 0x01) {
|
||||
outb(0x01, tmport);
|
||||
outb(0x01, dev->ioport[c] + 0x1b);
|
||||
while ((inb(dev->ioport[c] + 0x1b) & 0x01) != 0x01) {
|
||||
outb(0x01, dev->ioport[c] + 0x1b);
|
||||
}
|
||||
}
|
||||
/*
|
||||
|
|
@ -196,19 +189,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
||||
dev->last_cmd[c] = 0xff;
|
||||
}
|
||||
tmport -= 0x05;
|
||||
adrcnt = 0;
|
||||
((unsigned char *) &adrcnt)[2] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[1] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[0] = inb(tmport);
|
||||
((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
|
||||
((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
|
||||
((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
|
||||
k = dev->id[c][target_id].last_len;
|
||||
k -= adrcnt;
|
||||
dev->id[c][target_id].tran_len = k;
|
||||
dev->id[c][target_id].last_len = adrcnt;
|
||||
tmport -= 0x04;
|
||||
outb(0x41, tmport);
|
||||
tmport += 0x08;
|
||||
outb(0x08, tmport);
|
||||
outb(0x41, dev->ioport[c] + 0x10);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
}
|
||||
|
|
@ -227,10 +217,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
printk(KERN_DEBUG "Device reselect\n");
|
||||
#endif
|
||||
lun = 0;
|
||||
tmport -= 0x07;
|
||||
if (cmdp == 0x44 || i==0x80) {
|
||||
tmport += 0x0d;
|
||||
lun = inb(tmport) & 0x07;
|
||||
lun = inb(dev->ioport[c] + 0x1d) & 0x07;
|
||||
} else {
|
||||
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
||||
dev->last_cmd[c] = 0xff;
|
||||
|
|
@ -239,31 +227,27 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
#ifdef ED_DBGP
|
||||
printk("cmdp = 0x41\n");
|
||||
#endif
|
||||
tmport += 0x02;
|
||||
adrcnt = 0;
|
||||
((unsigned char *) &adrcnt)[2] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[1] = inb(tmport++);
|
||||
((unsigned char *) &adrcnt)[0] = inb(tmport);
|
||||
((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
|
||||
((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
|
||||
((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
|
||||
k = dev->id[c][target_id].last_len;
|
||||
k -= adrcnt;
|
||||
dev->id[c][target_id].tran_len = k;
|
||||
dev->id[c][target_id].last_len = adrcnt;
|
||||
tmport += 0x04;
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
} else {
|
||||
#ifdef ED_DBGP
|
||||
printk("cmdp != 0x41\n");
|
||||
#endif
|
||||
outb(0x46, tmport);
|
||||
outb(0x46, dev->ioport[c] + 0x10);
|
||||
dev->id[c][target_id].dirct = 0x00;
|
||||
tmport += 0x02;
|
||||
outb(0x00, tmport++);
|
||||
outb(0x00, tmport++);
|
||||
outb(0x00, tmport++);
|
||||
tmport += 0x03;
|
||||
outb(0x08, tmport);
|
||||
outb(0x00, dev->ioport[c] + 0x12);
|
||||
outb(0x00, dev->ioport[c] + 0x13);
|
||||
outb(0x00, dev->ioport[c] + 0x14);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
}
|
||||
|
|
@ -274,14 +258,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
if (dev->dev_id == ATP885_DEVID) {
|
||||
j = inb(dev->baseport + 0x29) & 0xfe;
|
||||
outb(j, dev->baseport + 0x29);
|
||||
tmport = dev->ioport[c] + 0x16;
|
||||
} else {
|
||||
tmport = dev->ioport[c] + 0x10;
|
||||
outb(0x45, tmport);
|
||||
tmport += 0x06;
|
||||
}
|
||||
|
||||
target_id = inb(tmport);
|
||||
} else
|
||||
outb(0x45, dev->ioport[c] + 0x10);
|
||||
|
||||
target_id = inb(dev->ioport[c] + 0x16);
|
||||
/*
|
||||
* Remap wide identifiers
|
||||
*/
|
||||
|
|
@ -290,10 +270,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
} else {
|
||||
target_id &= 0x07;
|
||||
}
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
tmport = dev->ioport[c] + 0x10;
|
||||
outb(0x45, tmport);
|
||||
}
|
||||
if (dev->dev_id == ATP885_DEVID)
|
||||
outb(0x45, dev->ioport[c] + 0x10);
|
||||
workreq = dev->id[c][target_id].curr_req;
|
||||
#ifdef ED_DBGP
|
||||
scmd_printk(KERN_DEBUG, workreq, "CDB");
|
||||
|
|
@ -302,18 +280,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
printk("\n");
|
||||
#endif
|
||||
|
||||
tmport = dev->ioport[c] + 0x0f;
|
||||
outb(lun, tmport);
|
||||
tmport += 0x02;
|
||||
outb(dev->id[c][target_id].devsp, tmport++);
|
||||
outb(lun, dev->ioport[c] + 0x0f);
|
||||
outb(dev->id[c][target_id].devsp, dev->ioport[c] + 0x11);
|
||||
adrcnt = dev->id[c][target_id].tran_len;
|
||||
k = dev->id[c][target_id].last_len;
|
||||
|
||||
outb(((unsigned char *) &k)[2], tmport++);
|
||||
outb(((unsigned char *) &k)[1], tmport++);
|
||||
outb(((unsigned char *) &k)[0], tmport++);
|
||||
outb(((unsigned char *) &k)[2], dev->ioport[c] + 0x12);
|
||||
outb(((unsigned char *) &k)[1], dev->ioport[c] + 0x13);
|
||||
outb(((unsigned char *) &k)[0], dev->ioport[c] + 0x14);
|
||||
#ifdef ED_DBGP
|
||||
printk("k %x, k[0] 0x%x k[1] 0x%x k[2] 0x%x\n", k, inb(tmport-1), inb(tmport-2), inb(tmport-3));
|
||||
printk("k %x, k[0] 0x%x k[1] 0x%x k[2] 0x%x\n", k, inb(dev->ioport[c] + 0x14), inb(dev->ioport[c] + 0x13), inb(dev->ioport[c] + 0x12));
|
||||
#endif
|
||||
/* Remap wide */
|
||||
j = target_id;
|
||||
|
|
@ -322,8 +298,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
}
|
||||
/* Add direction */
|
||||
j |= dev->id[c][target_id].dirct;
|
||||
outb(j, tmport++);
|
||||
outb(0x80,tmport);
|
||||
outb(j, dev->ioport[c] + 0x15);
|
||||
outb(0x80, dev->ioport[c] + 0x16);
|
||||
|
||||
/* enable 32 bit fifo transfer */
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
|
|
@ -336,21 +312,18 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
outb(i,tmpcip);
|
||||
} else if ((dev->dev_id == ATP880_DEVID1) ||
|
||||
(dev->dev_id == ATP880_DEVID2) ) {
|
||||
tmport = dev->ioport[c] - 0x05;
|
||||
if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
|
||||
outb((unsigned char) ((inb(tmport) & 0x3f) | 0xc0), tmport);
|
||||
outb((unsigned char) ((inb(dev->ioport[c] - 0x05) & 0x3f) | 0xc0), dev->ioport[c] - 0x05);///minus 0x05???
|
||||
} else {
|
||||
outb((unsigned char) (inb(tmport) & 0x3f), tmport);
|
||||
outb((unsigned char) (inb(dev->ioport[c] - 0x05) & 0x3f), dev->ioport[c] - 0x05);///minus 0x05???
|
||||
}
|
||||
} else {
|
||||
tmport = dev->ioport[c] + 0x3a;
|
||||
if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
|
||||
outb((unsigned char) ((inb(tmport) & 0xf3) | 0x08), tmport);
|
||||
outb((unsigned char) ((inb(dev->ioport[c] + 0x3a) & 0xf3) | 0x08), dev->ioport[c] + 0x3a);
|
||||
} else {
|
||||
outb((unsigned char) (inb(tmport) & 0xf3), tmport);
|
||||
outb((unsigned char) (inb(dev->ioport[c] + 0x3a) & 0xf3), dev->ioport[c] + 0x3a);
|
||||
}
|
||||
}
|
||||
tmport = dev->ioport[c] + 0x1b;
|
||||
j = 0;
|
||||
id = 1;
|
||||
id = id << target_id;
|
||||
|
|
@ -360,13 +333,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
if ((id & dev->wide_id[c]) != 0) {
|
||||
j |= 0x01;
|
||||
}
|
||||
outb(j, tmport);
|
||||
while ((inb(tmport) & 0x01) != j) {
|
||||
outb(j,tmport);
|
||||
outb(j, dev->ioport[c] + 0x1b);
|
||||
while ((inb(dev->ioport[c] + 0x1b) & 0x01) != j) {
|
||||
outb(j,dev->ioport[c] + 0x1b);
|
||||
}
|
||||
if (dev->id[c][target_id].last_len == 0) {
|
||||
tmport = dev->ioport[c] + 0x18;
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
dev->in_int[c] = 0;
|
||||
#ifdef ED_DBGP
|
||||
printk("dev->id[c][target_id].last_len = 0\n");
|
||||
|
|
@ -412,12 +384,11 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
outb(0x00, tmpcip);
|
||||
tmpcip -= 0x02;
|
||||
}
|
||||
tmport = dev->ioport[c] + 0x18;
|
||||
/*
|
||||
* Check transfer direction
|
||||
*/
|
||||
if (dev->id[c][target_id].dirct != 0) {
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
outb(0x01, tmpcip);
|
||||
dev->in_int[c] = 0;
|
||||
#ifdef ED_DBGP
|
||||
|
|
@ -425,7 +396,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
#endif
|
||||
goto handled;
|
||||
}
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
outb(0x09, tmpcip);
|
||||
dev->in_int[c] = 0;
|
||||
#ifdef ED_DBGP
|
||||
|
|
@ -454,8 +425,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
dev->last_cmd[c] = 0xff;
|
||||
}
|
||||
errstus = 0;
|
||||
tmport -= 0x08;
|
||||
errstus = inb(tmport);
|
||||
errstus = inb(dev->ioport[c] + 0x0f);
|
||||
if (((dev->r1f[c][target_id] & 0x10) != 0)&&(dev->dev_id==ATP885_DEVID)) {
|
||||
printk(KERN_WARNING "AEC67162 CRC ERROR !\n");
|
||||
errstus = 0x02;
|
||||
|
|
@ -486,10 +456,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
* Take it back wide
|
||||
*/
|
||||
if (dev->wide_id[c] != 0) {
|
||||
tmport = dev->ioport[c] + 0x1b;
|
||||
outb(0x01, tmport);
|
||||
while ((inb(tmport) & 0x01) != 0x01) {
|
||||
outb(0x01, tmport);
|
||||
outb(0x01, dev->ioport[c] + 0x1b);
|
||||
while ((inb(dev->ioport[c] + 0x1b) & 0x01) != 0x01) {
|
||||
outb(0x01, dev->ioport[c] + 0x1b);
|
||||
}
|
||||
}
|
||||
/*
|
||||
|
|
@ -521,21 +490,17 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
outb(0x06, tmpcip);
|
||||
outb(0x00, tmpcip);
|
||||
tmpcip = tmpcip - 2;
|
||||
tmport = dev->ioport[c] + 0x10;
|
||||
outb(0x41, tmport);
|
||||
outb(0x41, dev->ioport[c] + 0x10);
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
tmport += 2;
|
||||
k = dev->id[c][target_id].last_len;
|
||||
outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[0]), tmport);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[2]), dev->ioport[c] + 0x12);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[1]), dev->ioport[c] + 0x13);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[0]), dev->ioport[c] + 0x14);
|
||||
dev->id[c][target_id].dirct = 0x00;
|
||||
tmport += 0x04;
|
||||
} else {
|
||||
dev->id[c][target_id].dirct = 0x00;
|
||||
tmport += 0x08;
|
||||
}
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
outb(0x09, tmpcip);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
|
|
@ -547,43 +512,34 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
|||
outb(0x06, tmpcip);
|
||||
outb(0x00, tmpcip);
|
||||
tmpcip = tmpcip - 2;
|
||||
tmport = dev->ioport[c] + 0x10;
|
||||
outb(0x41, tmport);
|
||||
outb(0x41, dev->ioport[c] + 0x10);
|
||||
if (dev->dev_id == ATP885_DEVID) {
|
||||
tmport += 2;
|
||||
k = dev->id[c][target_id].last_len;
|
||||
outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[0]), tmport++);
|
||||
} else {
|
||||
tmport += 5;
|
||||
outb((unsigned char) (((unsigned char *) (&k))[2]), dev->ioport[c] + 0x12);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[1]), dev->ioport[c] + 0x13);
|
||||
outb((unsigned char) (((unsigned char *) (&k))[0]), dev->ioport[c] + 0x14);
|
||||
}
|
||||
outb((unsigned char) (inb(tmport) | 0x20), tmport);
|
||||
outb((unsigned char) (inb(dev->ioport[c] + 0x15) | 0x20), dev->ioport[c] + 0x15);
|
||||
dev->id[c][target_id].dirct = 0x20;
|
||||
tmport += 0x03;
|
||||
outb(0x08, tmport);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
outb(0x01, tmpcip);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
}
|
||||
tmport -= 0x07;
|
||||
if (i == 0x0a) {
|
||||
outb(0x30, tmport);
|
||||
outb(0x30, dev->ioport[c] + 0x10);
|
||||
} else {
|
||||
outb(0x46, tmport);
|
||||
outb(0x46, dev->ioport[c] + 0x10);
|
||||
}
|
||||
dev->id[c][target_id].dirct = 0x00;
|
||||
tmport += 0x02;
|
||||
outb(0x00, tmport++);
|
||||
outb(0x00, tmport++);
|
||||
outb(0x00, tmport++);
|
||||
tmport += 0x03;
|
||||
outb(0x08, tmport);
|
||||
outb(0x00, dev->ioport[c] + 0x12);
|
||||
outb(0x00, dev->ioport[c] + 0x13);
|
||||
outb(0x00, dev->ioport[c] + 0x14);
|
||||
outb(0x08, dev->ioport[c] + 0x18);
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
} else {
|
||||
// tmport = dev->ioport[c] + 0x17;
|
||||
// inb(tmport);
|
||||
// inb(dev->ioport[c] + 0x17);
|
||||
// dev->working[c] = 0;
|
||||
dev->in_int[c] = 0;
|
||||
goto handled;
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user