Commit | Line | Data |
---|---|---|
b2441318 | 1 | // SPDX-License-Identifier: GPL-2.0 |
4abdc6ee | 2 | #include <linux/kernel.h> |
5a0e3ad6 | 3 | #include <linux/gfp.h> |
4abdc6ee EO |
4 | #include <linux/ide.h> |
5 | #include <linux/jiffies.h> | |
6 | #include <linux/blkdev.h> | |
7 | ||
8 | DECLARE_WAIT_QUEUE_HEAD(ide_park_wq); | |
9 | ||
10 | static void issue_park_cmd(ide_drive_t *drive, unsigned long timeout) | |
11 | { | |
b65fac32 | 12 | ide_hwif_t *hwif = drive->hwif; |
4abdc6ee EO |
13 | struct request_queue *q = drive->queue; |
14 | struct request *rq; | |
15 | int rc; | |
16 | ||
17 | timeout += jiffies; | |
b65fac32 | 18 | spin_lock_irq(&hwif->lock); |
4abdc6ee | 19 | if (drive->dev_flags & IDE_DFLAG_PARKED) { |
2a2ca6a9 | 20 | int reset_timer = time_before(timeout, drive->sleep); |
201bffa4 | 21 | int start_queue = 0; |
4abdc6ee | 22 | |
4abdc6ee EO |
23 | drive->sleep = timeout; |
24 | wake_up_all(&ide_park_wq); | |
b65fac32 | 25 | if (reset_timer && del_timer(&hwif->timer)) |
201bffa4 | 26 | start_queue = 1; |
b65fac32 | 27 | spin_unlock_irq(&hwif->lock); |
201bffa4 | 28 | |
853280a4 | 29 | if (start_queue) |
60033520 | 30 | blk_mq_run_hw_queues(q, true); |
4abdc6ee EO |
31 | return; |
32 | } | |
b65fac32 | 33 | spin_unlock_irq(&hwif->lock); |
4abdc6ee | 34 | |
ff005a06 | 35 | rq = blk_get_request(q, REQ_OP_DRV_IN, 0); |
82ed4db4 CH |
36 | scsi_req(rq)->cmd[0] = REQ_PARK_HEADS; |
37 | scsi_req(rq)->cmd_len = 1; | |
2f5a8e80 | 38 | ide_req(rq)->type = ATA_PRIV_MISC; |
22ce0a7c | 39 | ide_req(rq)->special = &timeout; |
684da762 | 40 | blk_execute_rq(NULL, rq, 1); |
17d5363b | 41 | rc = scsi_req(rq)->result ? -EIO : 0; |
4abdc6ee EO |
42 | blk_put_request(rq); |
43 | if (rc) | |
44 | goto out; | |
45 | ||
46 | /* | |
47 | * Make sure that *some* command is sent to the drive after the | |
48 | * timeout has expired, so power management will be reenabled. | |
49 | */ | |
ff005a06 | 50 | rq = blk_get_request(q, REQ_OP_DRV_IN, BLK_MQ_REQ_NOWAIT); |
a492f075 | 51 | if (IS_ERR(rq)) |
4abdc6ee EO |
52 | goto out; |
53 | ||
82ed4db4 CH |
54 | scsi_req(rq)->cmd[0] = REQ_UNPARK_HEADS; |
55 | scsi_req(rq)->cmd_len = 1; | |
2f5a8e80 | 56 | ide_req(rq)->type = ATA_PRIV_MISC; |
9a6d5488 | 57 | spin_lock_irq(&hwif->lock); |
60033520 | 58 | ide_insert_request_head(drive, rq); |
9a6d5488 | 59 | spin_unlock_irq(&hwif->lock); |
4abdc6ee EO |
60 | |
61 | out: | |
62 | return; | |
63 | } | |
64 | ||
c4e66c36 BZ |
65 | ide_startstop_t ide_do_park_unpark(ide_drive_t *drive, struct request *rq) |
66 | { | |
22aa4b32 BZ |
67 | struct ide_cmd cmd; |
68 | struct ide_taskfile *tf = &cmd.tf; | |
c4e66c36 | 69 | |
22aa4b32 | 70 | memset(&cmd, 0, sizeof(cmd)); |
82ed4db4 | 71 | if (scsi_req(rq)->cmd[0] == REQ_PARK_HEADS) { |
22ce0a7c | 72 | drive->sleep = *(unsigned long *)ide_req(rq)->special; |
c4e66c36 BZ |
73 | drive->dev_flags |= IDE_DFLAG_SLEEPING; |
74 | tf->command = ATA_CMD_IDLEIMMEDIATE; | |
75 | tf->feature = 0x44; | |
76 | tf->lbal = 0x4c; | |
77 | tf->lbam = 0x4e; | |
78 | tf->lbah = 0x55; | |
60f85019 SS |
79 | cmd.valid.out.tf = IDE_VALID_OUT_TF | IDE_VALID_DEVICE; |
80 | cmd.valid.in.tf = IDE_VALID_IN_TF | IDE_VALID_DEVICE; | |
c4e66c36 BZ |
81 | } else /* cmd == REQ_UNPARK_HEADS */ |
82 | tf->command = ATA_CMD_CHK_POWER; | |
83 | ||
d364c7f5 | 84 | cmd.tf_flags |= IDE_TFLAG_CUSTOM_HANDLER; |
0dfb991c BZ |
85 | cmd.protocol = ATA_PROT_NODATA; |
86 | ||
22aa4b32 | 87 | cmd.rq = rq; |
22aa4b32 BZ |
88 | |
89 | return do_rw_taskfile(drive, &cmd); | |
c4e66c36 BZ |
90 | } |
91 | ||
4abdc6ee EO |
92 | ssize_t ide_park_show(struct device *dev, struct device_attribute *attr, |
93 | char *buf) | |
94 | { | |
95 | ide_drive_t *drive = to_ide_device(dev); | |
b65fac32 | 96 | ide_hwif_t *hwif = drive->hwif; |
4abdc6ee EO |
97 | unsigned long now; |
98 | unsigned int msecs; | |
99 | ||
100 | if (drive->dev_flags & IDE_DFLAG_NO_UNLOAD) | |
101 | return -EOPNOTSUPP; | |
102 | ||
b65fac32 | 103 | spin_lock_irq(&hwif->lock); |
4abdc6ee EO |
104 | now = jiffies; |
105 | if (drive->dev_flags & IDE_DFLAG_PARKED && | |
106 | time_after(drive->sleep, now)) | |
107 | msecs = jiffies_to_msecs(drive->sleep - now); | |
108 | else | |
109 | msecs = 0; | |
b65fac32 | 110 | spin_unlock_irq(&hwif->lock); |
4abdc6ee EO |
111 | |
112 | return snprintf(buf, 20, "%u\n", msecs); | |
113 | } | |
114 | ||
115 | ssize_t ide_park_store(struct device *dev, struct device_attribute *attr, | |
116 | const char *buf, size_t len) | |
117 | { | |
118 | #define MAX_PARK_TIMEOUT 30000 | |
119 | ide_drive_t *drive = to_ide_device(dev); | |
120 | long int input; | |
121 | int rc; | |
122 | ||
79c8fa0b JH |
123 | rc = kstrtol(buf, 10, &input); |
124 | if (rc) | |
125 | return rc; | |
126 | if (input < -2) | |
4abdc6ee EO |
127 | return -EINVAL; |
128 | if (input > MAX_PARK_TIMEOUT) { | |
129 | input = MAX_PARK_TIMEOUT; | |
130 | rc = -EOVERFLOW; | |
131 | } | |
132 | ||
133 | mutex_lock(&ide_setting_mtx); | |
134 | if (input >= 0) { | |
135 | if (drive->dev_flags & IDE_DFLAG_NO_UNLOAD) | |
136 | rc = -EOPNOTSUPP; | |
137 | else if (input || drive->dev_flags & IDE_DFLAG_PARKED) | |
138 | issue_park_cmd(drive, msecs_to_jiffies(input)); | |
139 | } else { | |
140 | if (drive->media == ide_disk) | |
141 | switch (input) { | |
142 | case -1: | |
143 | drive->dev_flags &= ~IDE_DFLAG_NO_UNLOAD; | |
144 | break; | |
145 | case -2: | |
146 | drive->dev_flags |= IDE_DFLAG_NO_UNLOAD; | |
147 | break; | |
148 | } | |
149 | else | |
150 | rc = -EOPNOTSUPP; | |
151 | } | |
152 | mutex_unlock(&ide_setting_mtx); | |
153 | ||
154 | return rc ? rc : len; | |
155 | } |