ide: move ide_do_park_unpark() to ide-park.c

Acked-by: Sergei Shtylyov <sshtylyov@ru.mvista.com>
Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>

1 files changed, 25 insertions, 0 deletions

diff --git a/drivers/ide/ide-park.c b/drivers/ide/ide-park.c
index c875a957596c..f30e52152fcb 100644
--- a/drivers/ide/ide-park.c
+++ b/drivers/ide/ide-park.c
@@ -1,5 +1,6 @@
 #include <linux/kernel.h>
 #include <linux/ide.h>
+#include <linux/hdreg.h>
 #include <linux/jiffies.h>
 #include <linux/blkdev.h>
 
@@ -60,6 +61,30 @@ out:
         return;
 }
 
+ide_startstop_t ide_do_park_unpark(ide_drive_t *drive, struct request *rq)
+{
+        ide_task_t task;
+        struct ide_taskfile *tf = &task.tf;
+
+        memset(&task, 0, sizeof(task));
+        if (rq->cmd[0] == REQ_PARK_HEADS) {
+                drive->sleep = *(unsigned long *)rq->special;
+                drive->dev_flags |= IDE_DFLAG_SLEEPING;
+                tf->command = ATA_CMD_IDLEIMMEDIATE;
+                tf->feature = 0x44;
+                tf->lbal = 0x4c;
+                tf->lbam = 0x4e;
+                tf->lbah = 0x55;
+                task.tf_flags |= IDE_TFLAG_CUSTOM_HANDLER;
+        } else          /* cmd == REQ_UNPARK_HEADS */
+                tf->command = ATA_CMD_CHK_POWER;
+
+        task.tf_flags |= IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
+        task.rq = rq;
+        drive->hwif->data_phase = task.data_phase = TASKFILE_NO_DATA;
+        return do_rw_taskfile(drive, &task);
+}
+
 ssize_t ide_park_show(struct device *dev, struct device_attribute *attr,
                       char *buf)
 {