ide-cd: use xfer_func_t in cdrom_pc_intr()

Unify writing and reading handling in cdrom_pc_intr() using xfer_func_t.

There should be no functionality changes caused by this patch.
Signed-off-by: NBartlomiej Zolnierkiewicz <bzolnier@gmail.com>
上级 468e4681
...@@ -1005,6 +1005,8 @@ static ide_startstop_t cdrom_transfer_packet_command (ide_drive_t *drive, ...@@ -1005,6 +1005,8 @@ static ide_startstop_t cdrom_transfer_packet_command (ide_drive_t *drive,
* Block read functions. * Block read functions.
*/ */
typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
/* /*
* Buffer up to SECTORS_TO_TRANSFER sectors from the drive in our sector * Buffer up to SECTORS_TO_TRANSFER sectors from the drive in our sector
* buffer. Once the first sector is added, any subsequent sectors are * buffer. Once the first sector is added, any subsequent sectors are
...@@ -1430,10 +1432,10 @@ static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block) ...@@ -1430,10 +1432,10 @@ static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block)
/* Interrupt routine for packet command completion. */ /* Interrupt routine for packet command completion. */
static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive) static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive)
{ {
int ireason, len, thislen;
struct request *rq = HWGROUP(drive)->rq; struct request *rq = HWGROUP(drive)->rq;
xfer_func_t *xferfunc = NULL;
int stat, ireason, len, thislen, write;
u8 lowcyl = 0, highcyl = 0; u8 lowcyl = 0, highcyl = 0;
int stat;
/* Check for errors. */ /* Check for errors. */
if (cdrom_decode_status(drive, 0, &stat)) if (cdrom_decode_status(drive, 0, &stat))
...@@ -1478,44 +1480,31 @@ static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive) ...@@ -1478,44 +1480,31 @@ static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive)
/* Figure out how much data to transfer. */ /* Figure out how much data to transfer. */
thislen = rq->data_len; thislen = rq->data_len;
if (thislen > len) thislen = len; if (thislen > len)
thislen = len;
/* The drive wants to be written to. */
if (ireason == 0) { if (ireason == 0) {
if (!rq->data) { write = 1;
blk_dump_rq_flags(rq, "cdrom_pc_intr, write"); xferfunc = HWIF(drive)->atapi_output_bytes;
goto confused; } else if (ireason == 2) {
} write = 0;
/* Transfer the data. */ xferfunc = HWIF(drive)->atapi_input_bytes;
HWIF(drive)->atapi_output_bytes(drive, rq->data, thislen);
/* If we haven't moved enough data to satisfy the drive,
add some padding. */
while (len > thislen) {
int dum = 0;
HWIF(drive)->atapi_output_bytes(drive, &dum, sizeof(dum));
len -= sizeof(dum);
}
/* Keep count of how much data we've moved. */
rq->data += thislen;
rq->data_len -= thislen;
} }
/* Same drill for reading. */ if (xferfunc) {
else if (ireason == 2) {
if (!rq->data) { if (!rq->data) {
blk_dump_rq_flags(rq, "cdrom_pc_intr, read"); blk_dump_rq_flags(rq, write ? "cdrom_pc_intr, write"
: "cdrom_pc_intr, read");
goto confused; goto confused;
} }
/* Transfer the data. */ /* Transfer the data. */
HWIF(drive)->atapi_input_bytes(drive, rq->data, thislen); xferfunc(drive, rq->data, thislen);
/* If we haven't moved enough data to satisfy the drive, /* If we haven't moved enough data to satisfy the drive,
add some padding. */ add some padding. */
while (len > thislen) { while (len > thislen) {
int dum = 0; int dum = 0;
HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum)); xferfunc(drive, &dum, sizeof(dum));
len -= sizeof(dum); len -= sizeof(dum);
} }
...@@ -1523,7 +1512,7 @@ static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive) ...@@ -1523,7 +1512,7 @@ static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive)
rq->data += thislen; rq->data += thislen;
rq->data_len -= thislen; rq->data_len -= thislen;
if (blk_sense_request(rq)) if (write && blk_sense_request(rq))
rq->sense_len += thislen; rq->sense_len += thislen;
} else { } else {
confused: confused:
...@@ -1658,8 +1647,6 @@ static int cdrom_newpc_intr_dummy_cb(struct request *rq) ...@@ -1658,8 +1647,6 @@ static int cdrom_newpc_intr_dummy_cb(struct request *rq)
return 1; return 1;
} }
typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
/* /*
* best way to deal with dma that is not sector aligned right now... note * best way to deal with dma that is not sector aligned right now... note
* that in this path we are not using ->data or ->buffer at all. this irs * that in this path we are not using ->data or ->buffer at all. this irs
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册