Commit 78614ecd authored by Ondrej Zary's avatar Ondrej Zary Committed by Martin K. Petersen

atp870u: Remove ugly gotos

Signed-off-by: default avatarOndrej Zary <linux@rainbow-software.org>
Reviewed-by: default avatarHannes Reinicke <hare@suse.de>
Acked-by: default avatarChristoph Hellwig <hch@lst.de>
Signed-off-by: default avatarMartin K. Petersen <martin.petersen@oracle.com>
parent c2bab403
...@@ -55,20 +55,17 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -55,20 +55,17 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#ifdef ED_DBGP #ifdef ED_DBGP
unsigned long l; unsigned long l;
#endif #endif
int errstus;
struct Scsi_Host *host = dev_id; struct Scsi_Host *host = 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++) {
j = inb(dev->ioport[c] + 0x1f); j = inb(dev->ioport[c] + 0x1f);
if ((j & 0x80) != 0) if ((j & 0x80) != 0)
{ break;
goto ch_sel;
}
dev->in_int[c] = 0; dev->in_int[c] = 0;
} }
return IRQ_NONE; if ((j & 0x80) == 0)
ch_sel: return IRQ_NONE;
#ifdef ED_DBGP #ifdef ED_DBGP
printk("atp870u_intr_handle enter\n"); printk("atp870u_intr_handle enter\n");
#endif #endif
...@@ -82,15 +79,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -82,15 +79,12 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
if ((inb(dev->pciport[c]) & 0x08) != 0) if ((inb(dev->pciport[c]) & 0x08) != 0)
{ {
for (k=0; k < 1000; k++) { for (k=0; k < 1000; k++) {
if ((inb(dev->pciport[c] + 2) & 0x08) == 0) { if ((inb(dev->pciport[c] + 2) & 0x08) == 0)
goto stop_dma; break;
} if ((inb(dev->pciport[c] + 2) & 0x01) == 0)
if ((inb(dev->pciport[c] + 2) & 0x01) == 0) { break;
goto stop_dma;
}
} }
} }
stop_dma:
outb(0x00, dev->pciport[c]); outb(0x00, dev->pciport[c]);
i = inb(dev->ioport[c] + 0x17); i = inb(dev->ioport[c] + 0x17);
...@@ -170,13 +164,13 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -170,13 +164,13 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#ifdef ED_DBGP #ifdef ED_DBGP
printk("Status 0x85 return\n"); printk("Status 0x85 return\n");
#endif #endif
goto handled; return IRQ_HANDLED;
} }
if (i == 0x40) { if (i == 0x40) {
dev->last_cmd[c] |= 0x40; dev->last_cmd[c] |= 0x40;
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
if (i == 0x21) { if (i == 0x21) {
...@@ -194,7 +188,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -194,7 +188,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x41, dev->ioport[c] + 0x10); outb(0x41, dev->ioport[c] + 0x10);
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
...@@ -231,7 +225,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -231,7 +225,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;
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} else { } else {
#ifdef ED_DBGP #ifdef ED_DBGP
printk("cmdp != 0x41\n"); printk("cmdp != 0x41\n");
...@@ -243,7 +237,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -243,7 +237,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x00, dev->ioport[c] + 0x14); outb(0x00, dev->ioport[c] + 0x14);
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
} }
if (dev->last_cmd[c] != 0xff) { if (dev->last_cmd[c] != 0xff) {
...@@ -336,7 +330,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -336,7 +330,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#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");
#endif #endif
goto handled; return IRQ_HANDLED;
} }
#ifdef ED_DBGP #ifdef ED_DBGP
printk("target_id = %d adrcnt = %d\n",target_id,adrcnt); printk("target_id = %d adrcnt = %d\n",target_id,adrcnt);
...@@ -382,7 +376,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -382,7 +376,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#ifdef ED_DBGP #ifdef ED_DBGP
printk("status 0x80 return dirct != 0\n"); printk("status 0x80 return dirct != 0\n");
#endif #endif
goto handled; return IRQ_HANDLED;
} }
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, dev->pciport[c]); outb(0x09, dev->pciport[c]);
...@@ -390,7 +384,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -390,7 +384,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
#ifdef ED_DBGP #ifdef ED_DBGP
printk("status 0x80 return dirct = 0\n"); printk("status 0x80 return dirct = 0\n");
#endif #endif
goto handled; return IRQ_HANDLED;
} }
/* /*
...@@ -399,27 +393,19 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -399,27 +393,19 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
workreq = dev->id[c][target_id].curr_req; workreq = dev->id[c][target_id].curr_req;
if (i == 0x42) { if (i == 0x42 || i == 0x16) {
if ((dev->last_cmd[c] & 0xf0) != 0x40)
{
dev->last_cmd[c] = 0xff;
}
errstus = 0x02;
workreq->result = errstus;
goto go_42;
}
if (i == 0x16) {
if ((dev->last_cmd[c] & 0xf0) != 0x40) { if ((dev->last_cmd[c] & 0xf0) != 0x40) {
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
} }
errstus = 0; if (i == 0x16) {
errstus = inb(dev->ioport[c] + 0x0f); workreq->result = inb(dev->ioport[c] + 0x0f);
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; workreq->result = 0x02;
} }
workreq->result = errstus; } else
go_42: workreq->result = 0x02;
if (dev->dev_id == ATP885_DEVID) { if (dev->dev_id == ATP885_DEVID) {
j = inb(dev->baseport + 0x29) | 0x01; j = inb(dev->baseport + 0x29) | 0x01;
outb(j, dev->baseport + 0x29); outb(j, dev->baseport + 0x29);
...@@ -462,7 +448,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -462,7 +448,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
} }
spin_unlock_irqrestore(dev->host->host_lock, flags); spin_unlock_irqrestore(dev->host->host_lock, flags);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
if ((dev->last_cmd[c] & 0xf0) != 0x40) { if ((dev->last_cmd[c] & 0xf0) != 0x40) {
dev->last_cmd[c] = 0xff; dev->last_cmd[c] = 0xff;
...@@ -488,7 +474,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -488,7 +474,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
outb(0x09, dev->pciport[c]); outb(0x09, dev->pciport[c]);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
if (i == 0x08) { if (i == 0x08) {
outl(dev->id[c][target_id].prdaddr, dev->pciport[c] + 4); outl(dev->id[c][target_id].prdaddr, dev->pciport[c] + 4);
...@@ -506,7 +492,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -506,7 +492,7 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
outb(0x01, dev->pciport[c]); outb(0x01, dev->pciport[c]);
dev->in_int[c] = 0; dev->in_int[c] = 0;
goto handled; return IRQ_HANDLED;
} }
if (i == 0x0a) { if (i == 0x0a) {
outb(0x30, dev->ioport[c] + 0x10); outb(0x30, dev->ioport[c] + 0x10);
...@@ -518,19 +504,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id) ...@@ -518,19 +504,9 @@ static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
outb(0x00, dev->ioport[c] + 0x13); outb(0x00, dev->ioport[c] + 0x13);
outb(0x00, dev->ioport[c] + 0x14); outb(0x00, dev->ioport[c] + 0x14);
outb(0x08, dev->ioport[c] + 0x18); outb(0x08, dev->ioport[c] + 0x18);
dev->in_int[c] = 0;
goto handled;
} else {
// inb(dev->ioport[c] + 0x17);
// dev->working[c] = 0;
dev->in_int[c] = 0;
goto handled;
} }
dev->in_int[c] = 0;
handled:
#ifdef ED_DBGP
printk("atp870u_intr_handle exit\n");
#endif
return IRQ_HANDLED; return IRQ_HANDLED;
} }
/** /**
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment