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

    ide: add ide_tf_load() helper
    
    Based on the earlier work by Tejun Heo.
    
    * Add 'tf_flags' field (for taskfile flags) to ide_task_t.
    
    * Add IDE_TFLAG_LBA48 taskfile flag for LBA48 taskfiles.
    
    * Add IDE_TFLAG_NO_SELECT_MASK taskfile flag for __ide_do_rw_disk()
      which doesn't use SELECT_MASK() (looks like a bug but it requires
      some more investigation).
    
    * Split off ide_tf_load() helper from do_rw_taskfile().
    
    * Convert __ide_do_rw_disk() to use ide_tf_load().
    
    There should be no functionality changes caused by this patch.
    
    Cc: Tejun Heo <[EMAIL PROTECTED]>
    Acked-by: Sergei Shtylyov <[EMAIL PROTECTED]>
    Signed-off-by: Bartlomiej Zolnierkiewicz <[EMAIL PROTECTED]>
---
 drivers/ide/ide-disk.c     |   28 ++++-----------------
 drivers/ide/ide-taskfile.c |   56 ++++++++++++++++++++++++++-----------------
 include/linux/ide.h        |    8 ++++++
 3 files changed, 48 insertions(+), 44 deletions(-)

diff --git a/drivers/ide/ide-disk.c b/drivers/ide/ide-disk.c
index 20d357e..6387222 100644
--- a/drivers/ide/ide-disk.c
+++ b/drivers/ide/ide-disk.c
@@ -140,7 +140,8 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t *drive, 
struct request *rq,
        u8 lba48                = (drive->addressing == 1) ? 1 : 0;
        u8 command              = WIN_NOP;
        ata_nsector_t           nsectors;
-       struct ide_taskfile ltf, *tf = &ltf;
+       ide_task_t              task;
+       struct ide_taskfile     *tf = &task.tf;
 
        nsectors.all            = (u16) rq->nr_sectors;
 
@@ -156,12 +157,8 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t 
*drive, struct request *rq,
                ide_map_sg(drive, rq);
        }
 
-       if (IDE_CONTROL_REG)
-               hwif->OUTB(drive->ctl, IDE_CONTROL_REG);
-
-       /* FIXME: SELECT_MASK(drive, 0) ? */
-
-       memset(tf, 0, sizeof(*tf));
+       memset(&task, 0, sizeof(task));
+       task.tf_flags = IDE_TFLAG_NO_SELECT_MASK;  /* FIXME? */
 
        if (drive->select.b.lba) {
                if (lba48) {
@@ -185,6 +182,7 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t *drive, 
struct request *rq,
                                tf->hob_lbah, tf->hob_lbam, tf->hob_lbal,
                                tf->lbah, tf->lbam, tf->lbal);
 #endif
+                       task.tf_flags |= IDE_TFLAG_LBA48;
                } else {
                        tf->nsect  = nsectors.b.low;
                        tf->lbal   = block;
@@ -208,21 +206,7 @@ static ide_startstop_t __ide_do_rw_disk(ide_drive_t 
*drive, struct request *rq,
                tf->device = head;
        }
 
-       if (drive->select.b.lba && lba48) {
-               hwif->OUTB(tf->hob_feature, IDE_FEATURE_REG);
-               hwif->OUTB(tf->hob_nsect, IDE_NSECTOR_REG);
-               hwif->OUTB(tf->hob_lbal, IDE_SECTOR_REG);
-               hwif->OUTB(tf->hob_lbam, IDE_LCYL_REG);
-               hwif->OUTB(tf->hob_lbah, IDE_HCYL_REG);
-       }
-
-       hwif->OUTB(tf->feature, IDE_FEATURE_REG);
-       hwif->OUTB(tf->nsect, IDE_NSECTOR_REG);
-       hwif->OUTB(tf->lbal, IDE_SECTOR_REG);
-       hwif->OUTB(tf->lbam, IDE_LCYL_REG);
-       hwif->OUTB(tf->lbah, IDE_HCYL_REG);
-
-       hwif->OUTB(tf->device | drive->select.all, IDE_SELECT_REG);
+       ide_tf_load(drive, &task);
 
        if (dma) {
                if (!hwif->dma_setup(drive)) {
diff --git a/drivers/ide/ide-taskfile.c b/drivers/ide/ide-taskfile.c
index 5a1a9f7..a79150e 100644
--- a/drivers/ide/ide-taskfile.c
+++ b/drivers/ide/ide-taskfile.c
@@ -63,6 +63,37 @@ static void taskfile_output_data(ide_drive_t *drive, void 
*buffer, u32 wcount)
        }
 }
 
+void ide_tf_load(ide_drive_t *drive, ide_task_t *task)
+{
+       ide_hwif_t *hwif = drive->hwif;
+       struct ide_taskfile *tf = &task->tf;
+       u8 HIHI = (task->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF;
+
+       if (IDE_CONTROL_REG)
+               hwif->OUTB(drive->ctl, IDE_CONTROL_REG); /* clear nIEN */
+
+       if ((task->tf_flags & IDE_TFLAG_NO_SELECT_MASK) == 0)
+               SELECT_MASK(drive, 0);
+
+       if (task->tf_flags & IDE_TFLAG_LBA48) {
+               hwif->OUTB(tf->hob_feature, IDE_FEATURE_REG);
+               hwif->OUTB(tf->hob_nsect, IDE_NSECTOR_REG);
+               hwif->OUTB(tf->hob_lbal, IDE_SECTOR_REG);
+               hwif->OUTB(tf->hob_lbam, IDE_LCYL_REG);
+               hwif->OUTB(tf->hob_lbah, IDE_HCYL_REG);
+       }
+
+       hwif->OUTB(tf->feature, IDE_FEATURE_REG);
+       hwif->OUTB(tf->nsect, IDE_NSECTOR_REG);
+       hwif->OUTB(tf->lbal, IDE_SECTOR_REG);
+       hwif->OUTB(tf->lbam, IDE_LCYL_REG);
+       hwif->OUTB(tf->lbah, IDE_HCYL_REG);
+
+       hwif->OUTB((tf->device & HIHI) | drive->select.all, IDE_SELECT_REG);
+}
+
+EXPORT_SYMBOL_GPL(ide_tf_load);
+
 int taskfile_lib_get_identify (ide_drive_t *drive, u8 *buf)
 {
        ide_task_t args;
@@ -83,30 +114,11 @@ ide_startstop_t do_rw_taskfile (ide_drive_t *drive, 
ide_task_t *task)
 {
        ide_hwif_t *hwif        = HWIF(drive);
        struct ide_taskfile *tf = &task->tf;
-       u8 HIHI                 = (drive->addressing == 1) ? 0xE0 : 0xEF;
 
-       /* ALL Command Block Executions SHALL clear nIEN, unless otherwise */
-       if (IDE_CONTROL_REG) {
-               /* clear nIEN */
-               hwif->OUTB(drive->ctl, IDE_CONTROL_REG);
-       }
-       SELECT_MASK(drive, 0);
+       if (drive->addressing == 1)
+               task->tf_flags |= IDE_TFLAG_LBA48;
 
-       if (drive->addressing == 1) {
-               hwif->OUTB(tf->hob_feature, IDE_FEATURE_REG);
-               hwif->OUTB(tf->hob_nsect, IDE_NSECTOR_REG);
-               hwif->OUTB(tf->hob_lbal, IDE_SECTOR_REG);
-               hwif->OUTB(tf->hob_lbam, IDE_LCYL_REG);
-               hwif->OUTB(tf->hob_lbah, IDE_HCYL_REG);
-       }
-
-       hwif->OUTB(tf->feature, IDE_FEATURE_REG);
-       hwif->OUTB(tf->nsect, IDE_NSECTOR_REG);
-       hwif->OUTB(tf->lbal, IDE_SECTOR_REG);
-       hwif->OUTB(tf->lbam, IDE_LCYL_REG);
-       hwif->OUTB(tf->lbah, IDE_HCYL_REG);
-
-       hwif->OUTB((tf->device & HIHI) | drive->select.all, IDE_SELECT_REG);
+       ide_tf_load(drive, task);
 
        if (task->handler != NULL) {
                if (task->prehandler != NULL) {
diff --git a/include/linux/ide.h b/include/linux/ide.h
index 69b78bb..e25fd0b 100644
--- a/include/linux/ide.h
+++ b/include/linux/ide.h
@@ -1060,6 +1060,11 @@ extern void ide_end_drive_cmd(ide_drive_t *, u8, u8);
  */
 extern int ide_wait_cmd(ide_drive_t *, u8, u8, u8, u8, u8 *);
 
+enum {
+       IDE_TFLAG_LBA48                 = (1 << 0),
+       IDE_TFLAG_NO_SELECT_MASK        = (1 << 1),
+};
+
 struct ide_taskfile {
        u8      hob_data;       /*  0: high data byte (for TASKFILE IOCTL) */
 
@@ -1094,6 +1099,7 @@ typedef struct ide_task_s {
                struct ide_taskfile     tf;
                u8                      tf_array[14];
        };
+       u8                      tf_flags;
        ide_reg_valid_t         tf_out_flags;
        ide_reg_valid_t         tf_in_flags;
        int                     data_phase;
@@ -1104,6 +1110,8 @@ typedef struct ide_task_s {
        void                    *special;       /* valid_t generally */
 } ide_task_t;
 
+void ide_tf_load(ide_drive_t *, ide_task_t *);
+
 extern u32 ide_read_24(ide_drive_t *);
 
 extern void SELECT_DRIVE(ide_drive_t *);
-
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