Commit f4bd4b90 authored by Tejun Heo's avatar Tejun Heo Committed by Jens Axboe

swim3: dequeue in-flight request

swim3 has at most single request in flight and already tracks it using
fd_req.  Convert it to dequeuing model by updating request fetching
and wrapping completion function.

[ Impact: dequeue in-flight request ]
Signed-off-by: default avatarTejun Heo <tj@kernel.org>
Signed-off-by: default avatarJens Axboe <jens.axboe@oracle.com>
parent a336ca6f
...@@ -251,6 +251,20 @@ static int floppy_release(struct gendisk *disk, fmode_t mode); ...@@ -251,6 +251,20 @@ static int floppy_release(struct gendisk *disk, fmode_t mode);
static int floppy_check_change(struct gendisk *disk); static int floppy_check_change(struct gendisk *disk);
static int floppy_revalidate(struct gendisk *disk); static int floppy_revalidate(struct gendisk *disk);
static bool swim3_end_request(int err, unsigned int nr_bytes)
{
if (__blk_end_request(fd_req, err, nr_bytes))
return true;
fd_req = NULL;
return false;
}
static bool swim3_end_request_cur(int err)
{
return swim3_end_request(err, blk_rq_cur_bytes(fd_req));
}
static void swim3_select(struct floppy_state *fs, int sel) static void swim3_select(struct floppy_state *fs, int sel)
{ {
struct swim3 __iomem *sw = fs->swim3; struct swim3 __iomem *sw = fs->swim3;
...@@ -310,7 +324,14 @@ static void start_request(struct floppy_state *fs) ...@@ -310,7 +324,14 @@ static void start_request(struct floppy_state *fs)
wake_up(&fs->wait); wake_up(&fs->wait);
return; return;
} }
while (fs->state == idle && (req = elv_next_request(swim3_queue))) { while (fs->state == idle) {
if (!fd_req) {
fd_req = elv_next_request(swim3_queue);
if (!fd_req)
break;
blkdev_dequeue_request(fd_req);
}
req = fd_req;
#if 0 #if 0
printk("do_fd_req: dev=%s cmd=%d sec=%ld nr_sec=%u buf=%p\n", printk("do_fd_req: dev=%s cmd=%d sec=%ld nr_sec=%u buf=%p\n",
req->rq_disk->disk_name, req->cmd, req->rq_disk->disk_name, req->cmd,
...@@ -320,11 +341,11 @@ static void start_request(struct floppy_state *fs) ...@@ -320,11 +341,11 @@ static void start_request(struct floppy_state *fs)
#endif #endif
if (blk_rq_pos(req) >= fs->total_secs) { if (blk_rq_pos(req) >= fs->total_secs) {
__blk_end_request_cur(req, -EIO); swim3_end_request_cur(-EIO);
continue; continue;
} }
if (fs->ejected) { if (fs->ejected) {
__blk_end_request_cur(req, -EIO); swim3_end_request_cur(-EIO);
continue; continue;
} }
...@@ -332,7 +353,7 @@ static void start_request(struct floppy_state *fs) ...@@ -332,7 +353,7 @@ static void start_request(struct floppy_state *fs)
if (fs->write_prot < 0) if (fs->write_prot < 0)
fs->write_prot = swim3_readbit(fs, WRITE_PROT); fs->write_prot = swim3_readbit(fs, WRITE_PROT);
if (fs->write_prot) { if (fs->write_prot) {
__blk_end_request_cur(req, -EIO); swim3_end_request_cur(-EIO);
continue; continue;
} }
} }
...@@ -505,7 +526,7 @@ static void act(struct floppy_state *fs) ...@@ -505,7 +526,7 @@ static void act(struct floppy_state *fs)
case do_transfer: case do_transfer:
if (fs->cur_cyl != fs->req_cyl) { if (fs->cur_cyl != fs->req_cyl) {
if (fs->retries > 5) { if (fs->retries > 5) {
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
return; return;
} }
...@@ -537,7 +558,7 @@ static void scan_timeout(unsigned long data) ...@@ -537,7 +558,7 @@ static void scan_timeout(unsigned long data)
out_8(&sw->intr_enable, 0); out_8(&sw->intr_enable, 0);
fs->cur_cyl = -1; fs->cur_cyl = -1;
if (fs->retries > 5) { if (fs->retries > 5) {
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
} else { } else {
...@@ -556,7 +577,7 @@ static void seek_timeout(unsigned long data) ...@@ -556,7 +577,7 @@ static void seek_timeout(unsigned long data)
out_8(&sw->select, RELAX); out_8(&sw->select, RELAX);
out_8(&sw->intr_enable, 0); out_8(&sw->intr_enable, 0);
printk(KERN_ERR "swim3: seek timeout\n"); printk(KERN_ERR "swim3: seek timeout\n");
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
} }
...@@ -580,7 +601,7 @@ static void settle_timeout(unsigned long data) ...@@ -580,7 +601,7 @@ static void settle_timeout(unsigned long data)
return; return;
} }
printk(KERN_ERR "swim3: seek settle timeout\n"); printk(KERN_ERR "swim3: seek settle timeout\n");
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
} }
...@@ -603,7 +624,7 @@ static void xfer_timeout(unsigned long data) ...@@ -603,7 +624,7 @@ static void xfer_timeout(unsigned long data)
printk(KERN_ERR "swim3: timeout %sing sector %ld\n", printk(KERN_ERR "swim3: timeout %sing sector %ld\n",
(rq_data_dir(fd_req)==WRITE? "writ": "read"), (rq_data_dir(fd_req)==WRITE? "writ": "read"),
(long)blk_rq_pos(fd_req)); (long)blk_rq_pos(fd_req));
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
} }
...@@ -634,7 +655,7 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id) ...@@ -634,7 +655,7 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id)
printk(KERN_ERR "swim3: seen sector but cyl=ff?\n"); printk(KERN_ERR "swim3: seen sector but cyl=ff?\n");
fs->cur_cyl = -1; fs->cur_cyl = -1;
if (fs->retries > 5) { if (fs->retries > 5) {
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
} else { } else {
...@@ -717,7 +738,7 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id) ...@@ -717,7 +738,7 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id)
printk("swim3: error %sing block %ld (err=%x)\n", printk("swim3: error %sing block %ld (err=%x)\n",
rq_data_dir(fd_req) == WRITE? "writ": "read", rq_data_dir(fd_req) == WRITE? "writ": "read",
(long)blk_rq_pos(fd_req), err); (long)blk_rq_pos(fd_req), err);
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
} }
} else { } else {
...@@ -726,12 +747,12 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id) ...@@ -726,12 +747,12 @@ static irqreturn_t swim3_interrupt(int irq, void *dev_id)
printk(KERN_ERR "swim3: fd dma: stat=%x resid=%d\n", stat, resid); printk(KERN_ERR "swim3: fd dma: stat=%x resid=%d\n", stat, resid);
printk(KERN_ERR " state=%d, dir=%x, intr=%x, err=%x\n", printk(KERN_ERR " state=%d, dir=%x, intr=%x, err=%x\n",
fs->state, rq_data_dir(fd_req), intr, err); fs->state, rq_data_dir(fd_req), intr, err);
__blk_end_request_cur(fd_req, -EIO); swim3_end_request_cur(-EIO);
fs->state = idle; fs->state = idle;
start_request(fs); start_request(fs);
break; break;
} }
if (__blk_end_request(fd_req, 0, fs->scount << 9)) { if (swim3_end_request(0, fs->scount << 9)) {
fs->req_sector += fs->scount; fs->req_sector += fs->scount;
if (fs->req_sector > fs->secpertrack) { if (fs->req_sector > fs->secpertrack) {
fs->req_sector -= fs->secpertrack; fs->req_sector -= fs->secpertrack;
......
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