Merge tag 'for-linus-5.11-rc8-tag' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6-microblaze.git] / drivers / ide / ide-park.c
1 // SPDX-License-Identifier: GPL-2.0
2 #include <linux/kernel.h>
3 #include <linux/gfp.h>
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 {
12         ide_hwif_t *hwif = drive->hwif;
13         struct request_queue *q = drive->queue;
14         struct request *rq;
15         int rc;
16
17         timeout += jiffies;
18         spin_lock_irq(&hwif->lock);
19         if (drive->dev_flags & IDE_DFLAG_PARKED) {
20                 int reset_timer = time_before(timeout, drive->sleep);
21                 int start_queue = 0;
22
23                 drive->sleep = timeout;
24                 wake_up_all(&ide_park_wq);
25                 if (reset_timer && del_timer(&hwif->timer))
26                         start_queue = 1;
27                 spin_unlock_irq(&hwif->lock);
28
29                 if (start_queue)
30                         blk_mq_run_hw_queues(q, true);
31                 return;
32         }
33         spin_unlock_irq(&hwif->lock);
34
35         rq = blk_get_request(q, REQ_OP_DRV_IN, 0);
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         ide_req(rq)->special = &timeout;
40         blk_execute_rq(q, NULL, rq, 1);
41         rc = scsi_req(rq)->result ? -EIO : 0;
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          */
50         rq = blk_get_request(q, REQ_OP_DRV_IN, BLK_MQ_REQ_NOWAIT);
51         if (IS_ERR(rq))
52                 goto out;
53
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         spin_lock_irq(&hwif->lock);
58         ide_insert_request_head(drive, rq);
59         spin_unlock_irq(&hwif->lock);
60
61 out:
62         return;
63 }
64
65 ide_startstop_t ide_do_park_unpark(ide_drive_t *drive, struct request *rq)
66 {
67         struct ide_cmd cmd;
68         struct ide_taskfile *tf = &cmd.tf;
69
70         memset(&cmd, 0, sizeof(cmd));
71         if (scsi_req(rq)->cmd[0] == REQ_PARK_HEADS) {
72                 drive->sleep = *(unsigned long *)ide_req(rq)->special;
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;
79                 cmd.valid.out.tf = IDE_VALID_OUT_TF | IDE_VALID_DEVICE;
80                 cmd.valid.in.tf  = IDE_VALID_IN_TF  | IDE_VALID_DEVICE;
81         } else          /* cmd == REQ_UNPARK_HEADS */
82                 tf->command = ATA_CMD_CHK_POWER;
83
84         cmd.tf_flags |= IDE_TFLAG_CUSTOM_HANDLER;
85         cmd.protocol = ATA_PROT_NODATA;
86
87         cmd.rq = rq;
88
89         return do_rw_taskfile(drive, &cmd);
90 }
91
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);
96         ide_hwif_t *hwif = drive->hwif;
97         unsigned long now;
98         unsigned int msecs;
99
100         if (drive->dev_flags & IDE_DFLAG_NO_UNLOAD)
101                 return -EOPNOTSUPP;
102
103         spin_lock_irq(&hwif->lock);
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;
110         spin_unlock_irq(&hwif->lock);
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
123         rc = kstrtol(buf, 10, &input);
124         if (rc)
125                 return rc;
126         if (input < -2)
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 }