Gitweb:     
http://git.kernel.org/git/?p=linux/kernel/git/torvalds/linux-2.6.git;a=commit;h=ba76ae3883ad9faa32a6b35271c6a407d6c96ca9
Commit:     ba76ae3883ad9faa32a6b35271c6a407d6c96ca9
Parent:     c52ea915d7fdc96819964b32eb124b5ccd22b9af
Author:     Bartlomiej Zolnierkiewicz <[EMAIL PROTECTED]>
AuthorDate: Fri Jan 25 22:17:16 2008 +0100
Committer:  Bartlomiej Zolnierkiewicz <[EMAIL PROTECTED]>
CommitDate: Fri Jan 25 22:17:16 2008 +0100

    ide-disk: add ide_tf_set_cmd() helper
    
    * Add ide_tf_set_cmd() helper for selecting/setting command and data phase
      (note: DMA data phases are there for completness, they are not required 
ATM).
    
    * Set IDE_TFLAG_WRITE taskfile flag for write requests in 
__ide_do_rw_disk().
    
    * Convert __ide_do_rw_disk() to use the new ide_tf_set_cmd() helper.
    
    There should be no functionality changes caused by this patch.
    
    Acked-by: Sergei Shtylyov <[EMAIL PROTECTED]>
    Signed-off-by: Bartlomiej Zolnierkiewicz <[EMAIL PROTECTED]>
---
 drivers/ide/ide-disk.c |   85 +++++++++++++++++++++++++++++++-----------------
 1 files changed, 55 insertions(+), 30 deletions(-)

diff --git a/drivers/ide/ide-disk.c b/drivers/ide/ide-disk.c
index 851374e..97abc91 100644
--- a/drivers/ide/ide-disk.c
+++ b/drivers/ide/ide-disk.c
@@ -129,6 +129,50 @@ static int lba_capacity_is_ok (struct hd_driveid *id)
        return 0;       /* lba_capacity value may be bad */
 }
 
+static const u8 ide_rw_cmds[] = {
+       WIN_MULTREAD,
+       WIN_MULTWRITE,
+       WIN_MULTREAD_EXT,
+       WIN_MULTWRITE_EXT,
+       WIN_READ,
+       WIN_WRITE,
+       WIN_READ_EXT,
+       WIN_WRITE_EXT,
+       WIN_READDMA,
+       WIN_WRITEDMA,
+       WIN_READDMA_EXT,
+       WIN_WRITEDMA_EXT,
+};
+
+static const u8 ide_data_phases[] = {
+       TASKFILE_MULTI_IN,
+       TASKFILE_MULTI_OUT,
+       TASKFILE_IN,
+       TASKFILE_OUT,
+       TASKFILE_IN_DMA,
+       TASKFILE_OUT_DMA,
+};
+
+static void ide_tf_set_cmd(ide_drive_t *drive, ide_task_t *task, u8 dma)
+{
+       u8 index, lba48, write;
+
+       lba48 = (task->tf_flags & IDE_TFLAG_LBA48) ? 2 : 0;
+       write = (task->tf_flags & IDE_TFLAG_WRITE) ? 1 : 0;
+
+       if (dma)
+               index = drive->vdma ? 4 : 8;
+       else
+               index = drive->mult_count ? 0 : 4;
+
+       task->tf.command = ide_rw_cmds[index + lba48 + write];
+
+       if (dma)
+               index = 8; /* fixup index */
+
+       task->data_phase = ide_data_phases[index / 2 + write];
+}
+
 /*
  * __ide_do_rw_disk() issues READ and WRITE commands to a disk,
  * using LBA if supported, or CHS otherwise, to address sectors.
@@ -139,7 +183,6 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t *drive, 
struct request *rq,
        unsigned int dma        = drive->using_dma;
        u16 nsectors            = (u16)rq->nr_sectors;
        u8 lba48                = (drive->addressing == 1) ? 1 : 0;
-       u8 command              = WIN_NOP;
        ide_task_t              task;
        struct ide_taskfile     *tf = &task.tf;
 
@@ -205,50 +248,32 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t 
*drive, struct request *rq,
                tf->device = head;
        }
 
+       if (rq_data_dir(rq))
+               task.tf_flags |= IDE_TFLAG_WRITE;
+
+       ide_tf_set_cmd(drive, &task, dma);
+
        ide_tf_load(drive, &task);
 
        if (dma) {
                if (!hwif->dma_setup(drive)) {
-                       if (rq_data_dir(rq)) {
-                               command = lba48 ? WIN_WRITEDMA_EXT : 
WIN_WRITEDMA;
-                               if (drive->vdma)
-                                       command = lba48 ? WIN_WRITE_EXT: 
WIN_WRITE;
-                       } else {
-                               command = lba48 ? WIN_READDMA_EXT : WIN_READDMA;
-                               if (drive->vdma)
-                                       command = lba48 ? WIN_READ_EXT: 
WIN_READ;
-                       }
-                       hwif->dma_exec_cmd(drive, command);
+                       hwif->dma_exec_cmd(drive, tf->command);
                        hwif->dma_start(drive);
                        return ide_started;
                }
                /* fallback to PIO */
+               ide_tf_set_cmd(drive, &task, 0);
                ide_init_sg_cmd(drive, rq);
        }
 
-       if (rq_data_dir(rq) == READ) {
-
-               if (drive->mult_count) {
-                       hwif->data_phase = TASKFILE_MULTI_IN;
-                       command = lba48 ? WIN_MULTREAD_EXT : WIN_MULTREAD;
-               } else {
-                       hwif->data_phase = TASKFILE_IN;
-                       command = lba48 ? WIN_READ_EXT : WIN_READ;
-               }
+       hwif->data_phase = task.data_phase;
 
-               ide_execute_command(drive, command, &task_in_intr,
+       if (rq_data_dir(rq) == READ) {
+               ide_execute_command(drive, tf->command, &task_in_intr,
                                    WAIT_WORSTCASE, NULL);
                return ide_started;
        } else {
-               if (drive->mult_count) {
-                       hwif->data_phase = TASKFILE_MULTI_OUT;
-                       command = lba48 ? WIN_MULTWRITE_EXT : WIN_MULTWRITE;
-               } else {
-                       hwif->data_phase = TASKFILE_OUT;
-                       command = lba48 ? WIN_WRITE_EXT : WIN_WRITE;
-               }
-
-               hwif->OUTBSYNC(drive, command, IDE_COMMAND_REG);
+               hwif->OUTBSYNC(drive, tf->command, IDE_COMMAND_REG);
                ndelay(400);    /* FIXME */
 
                return pre_task_out_intr(drive, rq);
-
To unsubscribe from this list: send the line "unsubscribe git-commits-head" in
the body of a message to [EMAIL PROTECTED]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to