1 #include <linux/kernel.h>
4 #include <linux/jiffies.h>
5 #include <linux/blkdev.h>
7 DECLARE_WAIT_QUEUE_HEAD(ide_park_wq
);
9 static void issue_park_cmd(ide_drive_t
*drive
, unsigned long timeout
)
11 ide_hwif_t
*hwif
= drive
->hwif
;
12 struct request_queue
*q
= drive
->queue
;
17 spin_lock_irq(&hwif
->lock
);
18 if (drive
->dev_flags
& IDE_DFLAG_PARKED
) {
19 int reset_timer
= time_before(timeout
, drive
->sleep
);
22 drive
->sleep
= timeout
;
23 wake_up_all(&ide_park_wq
);
24 if (reset_timer
&& del_timer(&hwif
->timer
))
26 spin_unlock_irq(&hwif
->lock
);
32 spin_unlock_irq(&hwif
->lock
);
34 rq
= blk_get_request(q
, REQ_OP_DRV_IN
, __GFP_RECLAIM
);
36 scsi_req(rq
)->cmd
[0] = REQ_PARK_HEADS
;
37 scsi_req(rq
)->cmd_len
= 1;
38 ide_req(rq
)->type
= ATA_PRIV_MISC
;
39 rq
->special
= &timeout
;
40 rc
= blk_execute_rq(q
, NULL
, rq
, 1);
46 * Make sure that *some* command is sent to the drive after the
47 * timeout has expired, so power management will be reenabled.
49 rq
= blk_get_request(q
, REQ_OP_DRV_IN
, GFP_NOWAIT
);
54 scsi_req(rq
)->cmd
[0] = REQ_UNPARK_HEADS
;
55 scsi_req(rq
)->cmd_len
= 1;
56 ide_req(rq
)->type
= ATA_PRIV_MISC
;
57 elv_add_request(q
, rq
, ELEVATOR_INSERT_FRONT
);
63 ide_startstop_t
ide_do_park_unpark(ide_drive_t
*drive
, struct request
*rq
)
66 struct ide_taskfile
*tf
= &cmd
.tf
;
68 memset(&cmd
, 0, sizeof(cmd
));
69 if (scsi_req(rq
)->cmd
[0] == REQ_PARK_HEADS
) {
70 drive
->sleep
= *(unsigned long *)rq
->special
;
71 drive
->dev_flags
|= IDE_DFLAG_SLEEPING
;
72 tf
->command
= ATA_CMD_IDLEIMMEDIATE
;
77 cmd
.valid
.out
.tf
= IDE_VALID_OUT_TF
| IDE_VALID_DEVICE
;
78 cmd
.valid
.in
.tf
= IDE_VALID_IN_TF
| IDE_VALID_DEVICE
;
79 } else /* cmd == REQ_UNPARK_HEADS */
80 tf
->command
= ATA_CMD_CHK_POWER
;
82 cmd
.tf_flags
|= IDE_TFLAG_CUSTOM_HANDLER
;
83 cmd
.protocol
= ATA_PROT_NODATA
;
87 return do_rw_taskfile(drive
, &cmd
);
90 ssize_t
ide_park_show(struct device
*dev
, struct device_attribute
*attr
,
93 ide_drive_t
*drive
= to_ide_device(dev
);
94 ide_hwif_t
*hwif
= drive
->hwif
;
98 if (drive
->dev_flags
& IDE_DFLAG_NO_UNLOAD
)
101 spin_lock_irq(&hwif
->lock
);
103 if (drive
->dev_flags
& IDE_DFLAG_PARKED
&&
104 time_after(drive
->sleep
, now
))
105 msecs
= jiffies_to_msecs(drive
->sleep
- now
);
108 spin_unlock_irq(&hwif
->lock
);
110 return snprintf(buf
, 20, "%u\n", msecs
);
113 ssize_t
ide_park_store(struct device
*dev
, struct device_attribute
*attr
,
114 const char *buf
, size_t len
)
116 #define MAX_PARK_TIMEOUT 30000
117 ide_drive_t
*drive
= to_ide_device(dev
);
121 rc
= kstrtol(buf
, 10, &input
);
126 if (input
> MAX_PARK_TIMEOUT
) {
127 input
= MAX_PARK_TIMEOUT
;
131 mutex_lock(&ide_setting_mtx
);
133 if (drive
->dev_flags
& IDE_DFLAG_NO_UNLOAD
)
135 else if (input
|| drive
->dev_flags
& IDE_DFLAG_PARKED
)
136 issue_park_cmd(drive
, msecs_to_jiffies(input
));
138 if (drive
->media
== ide_disk
)
141 drive
->dev_flags
&= ~IDE_DFLAG_NO_UNLOAD
;
144 drive
->dev_flags
|= IDE_DFLAG_NO_UNLOAD
;
150 mutex_unlock(&ide_setting_mtx
);
152 return rc
? rc
: len
;