Skip to content

Commit

Permalink
[PATCH] libata: reorganize ata_set_mode()
Browse files Browse the repository at this point in the history
Merge ata_host_set_pio() and ata_host_set_dma() into ata_set_mode()
and use function-level *dev to iterate over devices.  This eases
soon-to-follow ata_set_mode() interface change.

While at it, kill an unnecessary comment and normalize others.

Signed-off-by: Tejun Heo <htejun@gmail.com>
Signed-off-by: Jeff Garzik <jeff@garzik.org>
  • Loading branch information
Tejun Heo authored and Jeff Garzik committed Apr 1, 2006
1 parent 4f65977 commit e8e0619
Showing 1 changed file with 35 additions and 56 deletions.
91 changes: 35 additions & 56 deletions drivers/scsi/libata-core.c
Original file line number Diff line number Diff line change
Expand Up @@ -1771,47 +1771,6 @@ static int ata_dev_set_mode(struct ata_port *ap, struct ata_device *dev)
return 0;
}

static int ata_host_set_pio(struct ata_port *ap)
{
int i;

for (i = 0; i < ATA_MAX_DEVICES; i++) {
struct ata_device *dev = &ap->device[i];

if (!ata_dev_enabled(dev))
continue;

if (!dev->pio_mode) {
printk(KERN_WARNING "ata%u: no PIO support for device %d.\n", ap->id, i);
return -1;
}

dev->xfer_mode = dev->pio_mode;
dev->xfer_shift = ATA_SHIFT_PIO;
if (ap->ops->set_piomode)
ap->ops->set_piomode(ap, dev);
}

return 0;
}

static void ata_host_set_dma(struct ata_port *ap)
{
int i;

for (i = 0; i < ATA_MAX_DEVICES; i++) {
struct ata_device *dev = &ap->device[i];

if (!ata_dev_enabled(dev) || !dev->dma_mode)
continue;

dev->xfer_mode = dev->dma_mode;
dev->xfer_shift = ata_xfer_mode2shift(dev->dma_mode);
if (ap->ops->set_dmamode)
ap->ops->set_dmamode(ap, dev);
}
}

/**
* ata_set_mode - Program timings and issue SET FEATURES - XFER
* @ap: port on which timings will be programmed
Expand All @@ -1823,20 +1782,20 @@ static void ata_host_set_dma(struct ata_port *ap)
*/
static void ata_set_mode(struct ata_port *ap)
{
struct ata_device *dev;
int i, rc, used_dma = 0, found = 0;

/* step 1: calculate xfer_mask */
for (i = 0; i < ATA_MAX_DEVICES; i++) {
struct ata_device *dev = &ap->device[i];
unsigned int pio_mask, dma_mask;

dev = &ap->device[i];

if (!ata_dev_enabled(dev))
continue;

ata_dev_xfermask(ap, dev);

/* TODO: let LLDD filter dev->*_mask here */

pio_mask = ata_pack_xfermask(dev->pio_mask, 0, 0);
dma_mask = ata_pack_xfermask(0, dev->mwdma_mask, dev->udma_mask);
dev->pio_mode = ata_xfer_mask2mode(pio_mask);
Expand All @@ -1850,16 +1809,40 @@ static void ata_set_mode(struct ata_port *ap)
return;

/* step 2: always set host PIO timings */
rc = ata_host_set_pio(ap);
if (rc)
goto err_out;
for (i = 0; i < ATA_MAX_DEVICES; i++) {
dev = &ap->device[i];
if (!ata_dev_enabled(dev))
continue;

if (!dev->pio_mode) {
printk(KERN_WARNING "ata%u: dev %u no PIO support\n",
ap->id, dev->devno);
rc = -EINVAL;
goto err_out;
}

dev->xfer_mode = dev->pio_mode;
dev->xfer_shift = ATA_SHIFT_PIO;
if (ap->ops->set_piomode)
ap->ops->set_piomode(ap, dev);
}

/* step 3: set host DMA timings */
ata_host_set_dma(ap);
for (i = 0; i < ATA_MAX_DEVICES; i++) {
dev = &ap->device[i];

if (!ata_dev_enabled(dev) || !dev->dma_mode)
continue;

dev->xfer_mode = dev->dma_mode;
dev->xfer_shift = ata_xfer_mode2shift(dev->dma_mode);
if (ap->ops->set_dmamode)
ap->ops->set_dmamode(ap, dev);
}

/* step 4: update devices' xfer mode */
for (i = 0; i < ATA_MAX_DEVICES; i++) {
struct ata_device *dev = &ap->device[i];
dev = &ap->device[i];

if (!ata_dev_enabled(dev))
continue;
Expand All @@ -1869,17 +1852,13 @@ static void ata_set_mode(struct ata_port *ap)
goto err_out;
}

/*
* Record simplex status. If we selected DMA then the other
* host channels are not permitted to do so.
/* Record simplex status. If we selected DMA then the other
* host channels are not permitted to do so.
*/

if (used_dma && (ap->host_set->flags & ATA_HOST_SIMPLEX))
ap->host_set->simplex_claimed = 1;

/*
* Chip specific finalisation
*/
/* step5: chip specific finalisation */
if (ap->ops->post_set_mode)
ap->ops->post_set_mode(ap);

Expand Down

0 comments on commit e8e0619

Please sign in to comment.