提交 3a38e53e 编写于 作者: O Ondrej Zary 提交者: Martin K. Petersen

atp870u: Untangle tmport

Untangle the tmport crap so it becomes obvious what ports are accessed.
Signed-off-by: NOndrej Zary <linux@rainbow-software.org>
Reviewed-by: NHannes Reinicke <hare@suse.de>
Acked-by: NChristoph Hellwig <hch@lst.de>
Signed-off-by: NMartin K. Petersen <martin.petersen@oracle.com>
上级 b4263b3c
...@@ -51,7 +51,6 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -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 i, j, c, target_id, lun,cmdp;
unsigned char *prd; unsigned char *prd;
struct scsi_cmnd *workreq; struct scsi_cmnd *workreq;
unsigned int tmport;
unsigned long adrcnt, k; unsigned long adrcnt, k;
#ifdef ED_DBGP #ifdef ED_DBGP
unsigned long l; unsigned long l;
...@@ -61,8 +60,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -61,8 +60,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
struct atp_unit *dev = (struct atp_unit *)&host->hostdata; struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
for (c = 0; c < 2; c++) { for (c = 0; c < 2; c++) {
tmport = dev->ioport[c] + 0x1f; j = inb(dev->ioport[c] + 0x1f);
j = inb(tmport);
if ((j & 0x80) != 0) if ((j & 0x80) != 0)
{ {
goto ch_sel; goto ch_sel;
...@@ -97,9 +95,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -97,9 +95,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
stop_dma: stop_dma:
tmpcip = dev->pciport[c]; tmpcip = dev->pciport[c];
outb(0x00, tmpcip); outb(0x00, tmpcip);
tmport -= 0x08;
i = inb(tmport); i = inb(dev->ioport[c] + 0x17);
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
tmpcip += 2; tmpcip += 2;
...@@ -107,9 +104,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -107,9 +104,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
tmpcip -= 2; tmpcip -= 2;
} }
tmport -= 0x02; target_id = inb(dev->ioport[c] + 0x15);
target_id = inb(tmport);
tmport += 0x02;
/* /*
* Remap wide devices onto id numbers * Remap wide devices onto id numbers
...@@ -137,11 +132,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -137,11 +132,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
} }
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
tmport -= 0x05;
adrcnt = 0; adrcnt = 0;
((unsigned char *) &adrcnt)[2] = inb(tmport++); ((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
((unsigned char *) &adrcnt)[1] = inb(tmport++); ((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
((unsigned char *) &adrcnt)[0] = inb(tmport); ((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
if (dev->id[c][target_id].last_len != adrcnt) if (dev->id[c][target_id].last_len != adrcnt)
{ {
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
...@@ -150,7 +144,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -150,7 +144,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
dev->id[c][target_id].last_len = adrcnt; dev->id[c][target_id].last_len = adrcnt;
} }
#ifdef ED_DBGP #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 #endif
} }
...@@ -158,10 +152,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -158,10 +152,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
* Flip wide * Flip wide
*/ */
if (dev->wide_id[c] != 0) { if (dev->wide_id[c] != 0) {
tmport = dev->ioport[c] + 0x1b; outb(0x01, dev->ioport[c] + 0x1b);
outb(0x01, tmport); while ((inb(dev->ioport[c] + 0x1b) & 0x01) != 0x01) {
while ((inb(tmport) & 0x01) != 0x01) { outb(0x01, dev->ioport[c] + 0x1b);
outb(0x01, tmport);
} }
} }
/* /*
...@@ -196,19 +189,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -196,19 +189,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
if ((dev->last_cmd[c] & 0xf0) != 0x40) { if ((dev->last_cmd[c] & 0xf0) != 0x40) {
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
} }
tmport -= 0x05;
adrcnt = 0; adrcnt = 0;
((unsigned char *) &adrcnt)[2] = inb(tmport++); ((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
((unsigned char *) &adrcnt)[1] = inb(tmport++); ((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
((unsigned char *) &adrcnt)[0] = inb(tmport); ((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
k -= adrcnt; k -= adrcnt;
dev->id[c][target_id].tran_len = k; dev->id[c][target_id].tran_len = k;
dev->id[c][target_id].last_len = adrcnt; dev->id[c][target_id].last_len = adrcnt;
tmport -= 0x04; outb(0x41, dev->ioport[c] + 0x10);
outb(0x41, tmport); outb(0x08, dev->ioport[c] + 0x18);
tmport += 0x08;
outb(0x08, tmport);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
} }
...@@ -227,10 +217,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -227,10 +217,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
printk(KERN_DEBUG "Device reselect\n"); printk(KERN_DEBUG "Device reselect\n");
#endif #endif
lun = 0; lun = 0;
tmport -= 0x07;
if (cmdp == 0x44 || i==0x80) { if (cmdp == 0x44 || i==0x80) {
tmport += 0x0d; lun = inb(dev->ioport[c] + 0x1d) & 0x07;
lun = inb(tmport) & 0x07;
} else { } else {
if ((dev->last_cmd[c] & 0xf0) != 0x40) { if ((dev->last_cmd[c] & 0xf0) != 0x40) {
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
...@@ -239,31 +227,27 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -239,31 +227,27 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#ifdef ED_DBGP #ifdef ED_DBGP
printk("cmdp = 0x41\n"); printk("cmdp = 0x41\n");
#endif #endif
tmport += 0x02;
adrcnt = 0; adrcnt = 0;
((unsigned char *) &adrcnt)[2] = inb(tmport++); ((unsigned char *) &adrcnt)[2] = inb(dev->ioport[c] + 0x12);
((unsigned char *) &adrcnt)[1] = inb(tmport++); ((unsigned char *) &adrcnt)[1] = inb(dev->ioport[c] + 0x13);
((unsigned char *) &adrcnt)[0] = inb(tmport); ((unsigned char *) &adrcnt)[0] = inb(dev->ioport[c] + 0x14);
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
k -= adrcnt; k -= adrcnt;
dev->id[c][target_id].tran_len = k; dev->id[c][target_id].tran_len = k;
dev->id[c][target_id].last_len = adrcnt; dev->id[c][target_id].last_len = adrcnt;
tmport += 0x04; outb(0x08, dev->ioport[c] + 0x18);
outb(0x08, tmport);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
} else { } else {
#ifdef ED_DBGP #ifdef ED_DBGP
printk("cmdp != 0x41\n"); printk("cmdp != 0x41\n");
#endif #endif
outb(0x46, tmport); outb(0x46, dev->ioport[c] + 0x10);
dev->id[c][target_id].dirct = 0x00; dev->id[c][target_id].dirct = 0x00;
tmport += 0x02; outb(0x00, dev->ioport[c] + 0x12);
outb(0x00, tmport++); outb(0x00, dev->ioport[c] + 0x13);
outb(0x00, tmport++); outb(0x00, dev->ioport[c] + 0x14);
outb(0x00, tmport++); outb(0x08, dev->ioport[c] + 0x18);
tmport += 0x03;
outb(0x08, tmport);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
} }
...@@ -274,14 +258,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -274,14 +258,10 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
j = inb(dev->baseport + 0x29) & 0xfe; j = inb(dev->baseport + 0x29) & 0xfe;
outb(j, dev->baseport + 0x29); outb(j, dev->baseport + 0x29);
tmport = dev->ioport[c] + 0x16; } else
} else { outb(0x45, dev->ioport[c] + 0x10);
tmport = dev->ioport[c] + 0x10;
outb(0x45, tmport); target_id = inb(dev->ioport[c] + 0x16);
tmport += 0x06;
}
target_id = inb(tmport);
/* /*
* Remap wide identifiers * Remap wide identifiers
*/ */
...@@ -290,10 +270,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -290,10 +270,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
} else { } else {
target_id &= 0x07; target_id &= 0x07;
} }
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID)
tmport = dev->ioport[c] + 0x10; outb(0x45, dev->ioport[c] + 0x10);
outb(0x45, tmport);
}
workreq = dev->id[c][target_id].curr_req; workreq = dev->id[c][target_id].curr_req;
#ifdef ED_DBGP #ifdef ED_DBGP
scmd_printk(KERN_DEBUG, workreq, "CDB"); scmd_printk(KERN_DEBUG, workreq, "CDB");
...@@ -302,18 +280,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -302,18 +280,16 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
printk("\n"); printk("\n");
#endif #endif
tmport = dev->ioport[c] + 0x0f; outb(lun, dev->ioport[c] + 0x0f);
outb(lun, tmport); outb(dev->id[c][target_id].devsp, dev->ioport[c] + 0x11);
tmport += 0x02;
outb(dev->id[c][target_id].devsp, tmport++);
adrcnt = dev->id[c][target_id].tran_len; adrcnt = dev->id[c][target_id].tran_len;
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
outb(((unsigned char *) &k)[2], tmport++); outb(((unsigned char *) &k)[2], dev->ioport[c] + 0x12);
outb(((unsigned char *) &k)[1], tmport++); outb(((unsigned char *) &k)[1], dev->ioport[c] + 0x13);
outb(((unsigned char *) &k)[0], tmport++); outb(((unsigned char *) &k)[0], dev->ioport[c] + 0x14);
#ifdef ED_DBGP #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 #endif
/* Remap wide */ /* Remap wide */
j = target_id; j = target_id;
...@@ -322,8 +298,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -322,8 +298,8 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
} }
/* Add direction */ /* Add direction */
j |= dev->id[c][target_id].dirct; j |= dev->id[c][target_id].dirct;
outb(j, tmport++); outb(j, dev->ioport[c] + 0x15);
outb(0x80,tmport); outb(0x80, dev->ioport[c] + 0x16);
/* enable 32 bit fifo transfer */ /* enable 32 bit fifo transfer */
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
...@@ -336,21 +312,18 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -336,21 +312,18 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(i,tmpcip); outb(i,tmpcip);
} else if ((dev->dev_id == ATP880_DEVID1) || } else if ((dev->dev_id == ATP880_DEVID1) ||
(dev->dev_id == ATP880_DEVID2) ) { (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)) { 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 { } else {
outb((unsigned char) (inb(tmport) & 0x3f), tmport); outb((unsigned char) (inb(dev->ioport[c] - 0x05) & 0x3f), dev->ioport[c] - 0x05);///minus 0x05???
} }
} else { } else {
tmport = dev->ioport[c] + 0x3a;
if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) { 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 { } 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; j = 0;
id = 1; id = 1;
id = id << target_id; id = id << target_id;
...@@ -360,13 +333,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -360,13 +333,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
if ((id & dev->wide_id[c]) != 0) { if ((id & dev->wide_id[c]) != 0) {
j |= 0x01; j |= 0x01;
} }
outb(j, tmport); outb(j, dev->ioport[c] + 0x1b);
while ((inb(tmport) & 0x01) != j) { while ((inb(dev->ioport[c] + 0x1b) & 0x01) != j) {
outb(j,tmport); outb(j,dev->ioport[c] + 0x1b);
} }
if (dev->id[c][target_id].last_len == 0) { if (dev->id[c][target_id].last_len == 0) {
tmport = dev->ioport[c] + 0x18; outb(0x08, dev->ioport[c] + 0x18);
outb(0x08, tmport);
dev->in_int[c] = 0; dev->in_int[c] = 0;
#ifdef ED_DBGP #ifdef ED_DBGP
printk("dev->id[c][target_id].last_len = 0\n"); 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) ...@@ -412,12 +384,11 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x00, tmpcip); outb(0x00, tmpcip);
tmpcip -= 0x02; tmpcip -= 0x02;
} }
tmport = dev->ioport[c] + 0x18;
/* /*
* Check transfer direction * Check transfer direction
*/ */
if (dev->id[c][target_id].dirct != 0) { if (dev->id[c][target_id].dirct != 0) {
outb(0x08, tmport); outb(0x08, dev->ioport[c] + 0x18);
outb(0x01, tmpcip); outb(0x01, tmpcip);
dev->in_int[c] = 0; dev->in_int[c] = 0;
#ifdef ED_DBGP #ifdef ED_DBGP
...@@ -425,7 +396,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -425,7 +396,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#endif #endif
goto handled; goto handled;
} }
outb(0x08, tmport); outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, tmpcip); outb(0x09, tmpcip);
dev->in_int[c] = 0; dev->in_int[c] = 0;
#ifdef ED_DBGP #ifdef ED_DBGP
...@@ -454,8 +425,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -454,8 +425,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
} }
errstus = 0; errstus = 0;
tmport -= 0x08; errstus = inb(dev->ioport[c] + 0x0f);
errstus = inb(tmport);
if (((dev->r1f[c][target_id] & 0x10) != 0)&&(dev->dev_id==ATP885_DEVID)) { if (((dev->r1f[c][target_id] & 0x10) != 0)&&(dev->dev_id==ATP885_DEVID)) {
printk(KERN_WARNING "AEC67162 CRC ERROR !\n"); printk(KERN_WARNING "AEC67162 CRC ERROR !\n");
errstus = 0x02; errstus = 0x02;
...@@ -486,10 +456,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -486,10 +456,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
* Take it back wide * Take it back wide
*/ */
if (dev->wide_id[c] != 0) { if (dev->wide_id[c] != 0) {
tmport = dev->ioport[c] + 0x1b; outb(0x01, dev->ioport[c] + 0x1b);
outb(0x01, tmport); while ((inb(dev->ioport[c] + 0x1b) & 0x01) != 0x01) {
while ((inb(tmport) & 0x01) != 0x01) { outb(0x01, dev->ioport[c] + 0x1b);
outb(0x01, tmport);
} }
} }
/* /*
...@@ -521,21 +490,17 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -521,21 +490,17 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x06, tmpcip); outb(0x06, tmpcip);
outb(0x00, tmpcip); outb(0x00, tmpcip);
tmpcip = tmpcip - 2; tmpcip = tmpcip - 2;
tmport = dev->ioport[c] + 0x10; outb(0x41, dev->ioport[c] + 0x10);
outb(0x41, tmport);
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
tmport += 2;
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++); outb((unsigned char) (((unsigned char *) (&k))[2]), dev->ioport[c] + 0x12);
outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++); outb((unsigned char) (((unsigned char *) (&k))[1]), dev->ioport[c] + 0x13);
outb((unsigned char) (((unsigned char *) (&k))[0]), tmport); outb((unsigned char) (((unsigned char *) (&k))[0]), dev->ioport[c] + 0x14);
dev->id[c][target_id].dirct = 0x00; dev->id[c][target_id].dirct = 0x00;
tmport += 0x04;
} else { } else {
dev->id[c][target_id].dirct = 0x00; dev->id[c][target_id].dirct = 0x00;
tmport += 0x08;
} }
outb(0x08, tmport); outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, tmpcip); outb(0x09, tmpcip);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
...@@ -547,43 +512,34 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -547,43 +512,34 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x06, tmpcip); outb(0x06, tmpcip);
outb(0x00, tmpcip); outb(0x00, tmpcip);
tmpcip = tmpcip - 2; tmpcip = tmpcip - 2;
tmport = dev->ioport[c] + 0x10; outb(0x41, dev->ioport[c] + 0x10);
outb(0x41, tmport);
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
tmport += 2;
k = dev->id[c][target_id].last_len; k = dev->id[c][target_id].last_len;
outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++); outb((unsigned char) (((unsigned char *) (&k))[2]), dev->ioport[c] + 0x12);
outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++); outb((unsigned char) (((unsigned char *) (&k))[1]), dev->ioport[c] + 0x13);
outb((unsigned char) (((unsigned char *) (&k))[0]), tmport++); outb((unsigned char) (((unsigned char *) (&k))[0]), dev->ioport[c] + 0x14);
} else {
tmport += 5;
} }
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; dev->id[c][target_id].dirct = 0x20;
tmport += 0x03; outb(0x08, dev->ioport[c] + 0x18);
outb(0x08, tmport);
outb(0x01, tmpcip); outb(0x01, tmpcip);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
} }
tmport -= 0x07;
if (i == 0x0a) { if (i == 0x0a) {
outb(0x30, tmport); outb(0x30, dev->ioport[c] + 0x10);
} else { } else {
outb(0x46, tmport); outb(0x46, dev->ioport[c] + 0x10);
} }
dev->id[c][target_id].dirct = 0x00; dev->id[c][target_id].dirct = 0x00;
tmport += 0x02; outb(0x00, dev->ioport[c] + 0x12);
outb(0x00, tmport++); outb(0x00, dev->ioport[c] + 0x13);
outb(0x00, tmport++); outb(0x00, dev->ioport[c] + 0x14);
outb(0x00, tmport++); outb(0x08, dev->ioport[c] + 0x18);
tmport += 0x03;
outb(0x08, tmport);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
} else { } else {
// tmport = dev->ioport[c] + 0x17; // inb(dev->ioport[c] + 0x17);
// inb(tmport);
// dev->working[c] = 0; // dev->working[c] = 0;
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; goto handled;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册