Merge branch 'for-3.6-fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/tj/wq
[platform/adaptation/renesas_rcar/renesas_kernel.git] / drivers / ide / ide-devsets.c
1
2 #include <linux/kernel.h>
3 #include <linux/gfp.h>
4 #include <linux/ide.h>
5
6 DEFINE_MUTEX(ide_setting_mtx);
7
8 ide_devset_get(io_32bit, io_32bit);
9
10 static int set_io_32bit(ide_drive_t *drive, int arg)
11 {
12         if (drive->dev_flags & IDE_DFLAG_NO_IO_32BIT)
13                 return -EPERM;
14
15         if (arg < 0 || arg > 1 + (SUPPORT_VLB_SYNC << 1))
16                 return -EINVAL;
17
18         drive->io_32bit = arg;
19
20         return 0;
21 }
22
23 ide_devset_get_flag(ksettings, IDE_DFLAG_KEEP_SETTINGS);
24
25 static int set_ksettings(ide_drive_t *drive, int arg)
26 {
27         if (arg < 0 || arg > 1)
28                 return -EINVAL;
29
30         if (arg)
31                 drive->dev_flags |= IDE_DFLAG_KEEP_SETTINGS;
32         else
33                 drive->dev_flags &= ~IDE_DFLAG_KEEP_SETTINGS;
34
35         return 0;
36 }
37
38 ide_devset_get_flag(using_dma, IDE_DFLAG_USING_DMA);
39
40 static int set_using_dma(ide_drive_t *drive, int arg)
41 {
42 #ifdef CONFIG_BLK_DEV_IDEDMA
43         int err = -EPERM;
44
45         if (arg < 0 || arg > 1)
46                 return -EINVAL;
47
48         if (ata_id_has_dma(drive->id) == 0)
49                 goto out;
50
51         if (drive->hwif->dma_ops == NULL)
52                 goto out;
53
54         err = 0;
55
56         if (arg) {
57                 if (ide_set_dma(drive))
58                         err = -EIO;
59         } else
60                 ide_dma_off(drive);
61
62 out:
63         return err;
64 #else
65         if (arg < 0 || arg > 1)
66                 return -EINVAL;
67
68         return -EPERM;
69 #endif
70 }
71
72 /*
73  * handle HDIO_SET_PIO_MODE ioctl abusers here, eventually it will go away
74  */
75 static int set_pio_mode_abuse(ide_hwif_t *hwif, u8 req_pio)
76 {
77         switch (req_pio) {
78         case 202:
79         case 201:
80         case 200:
81         case 102:
82         case 101:
83         case 100:
84                 return (hwif->host_flags & IDE_HFLAG_ABUSE_DMA_MODES) ? 1 : 0;
85         case 9:
86         case 8:
87                 return (hwif->host_flags & IDE_HFLAG_ABUSE_PREFETCH) ? 1 : 0;
88         case 7:
89         case 6:
90                 return (hwif->host_flags & IDE_HFLAG_ABUSE_FAST_DEVSEL) ? 1 : 0;
91         default:
92                 return 0;
93         }
94 }
95
96 static int set_pio_mode(ide_drive_t *drive, int arg)
97 {
98         ide_hwif_t *hwif = drive->hwif;
99         const struct ide_port_ops *port_ops = hwif->port_ops;
100
101         if (arg < 0 || arg > 255)
102                 return -EINVAL;
103
104         if (port_ops == NULL || port_ops->set_pio_mode == NULL ||
105             (hwif->host_flags & IDE_HFLAG_NO_SET_MODE))
106                 return -ENOSYS;
107
108         if (set_pio_mode_abuse(drive->hwif, arg)) {
109                 drive->pio_mode = arg + XFER_PIO_0;
110
111                 if (arg == 8 || arg == 9) {
112                         unsigned long flags;
113
114                         /* take lock for IDE_DFLAG_[NO_]UNMASK/[NO_]IO_32BIT */
115                         spin_lock_irqsave(&hwif->lock, flags);
116                         port_ops->set_pio_mode(hwif, drive);
117                         spin_unlock_irqrestore(&hwif->lock, flags);
118                 } else
119                         port_ops->set_pio_mode(hwif, drive);
120         } else {
121                 int keep_dma = !!(drive->dev_flags & IDE_DFLAG_USING_DMA);
122
123                 ide_set_pio(drive, arg);
124
125                 if (hwif->host_flags & IDE_HFLAG_SET_PIO_MODE_KEEP_DMA) {
126                         if (keep_dma)
127                                 ide_dma_on(drive);
128                 }
129         }
130
131         return 0;
132 }
133
134 ide_devset_get_flag(unmaskirq, IDE_DFLAG_UNMASK);
135
136 static int set_unmaskirq(ide_drive_t *drive, int arg)
137 {
138         if (drive->dev_flags & IDE_DFLAG_NO_UNMASK)
139                 return -EPERM;
140
141         if (arg < 0 || arg > 1)
142                 return -EINVAL;
143
144         if (arg)
145                 drive->dev_flags |= IDE_DFLAG_UNMASK;
146         else
147                 drive->dev_flags &= ~IDE_DFLAG_UNMASK;
148
149         return 0;
150 }
151
152 ide_ext_devset_rw_sync(io_32bit, io_32bit);
153 ide_ext_devset_rw_sync(keepsettings, ksettings);
154 ide_ext_devset_rw_sync(unmaskirq, unmaskirq);
155 ide_ext_devset_rw_sync(using_dma, using_dma);
156 __IDE_DEVSET(pio_mode, DS_SYNC, NULL, set_pio_mode);
157
158 int ide_devset_execute(ide_drive_t *drive, const struct ide_devset *setting,
159                        int arg)
160 {
161         struct request_queue *q = drive->queue;
162         struct request *rq;
163         int ret = 0;
164
165         if (!(setting->flags & DS_SYNC))
166                 return setting->set(drive, arg);
167
168         rq = blk_get_request(q, READ, __GFP_WAIT);
169         rq->cmd_type = REQ_TYPE_SPECIAL;
170         rq->cmd_len = 5;
171         rq->cmd[0] = REQ_DEVSET_EXEC;
172         *(int *)&rq->cmd[1] = arg;
173         rq->special = setting->set;
174
175         if (blk_execute_rq(q, NULL, rq, 0))
176                 ret = rq->errors;
177         blk_put_request(rq);
178
179         return ret;
180 }
181
182 ide_startstop_t ide_do_devset(ide_drive_t *drive, struct request *rq)
183 {
184         int err, (*setfunc)(ide_drive_t *, int) = rq->special;
185
186         err = setfunc(drive, *(int *)&rq->cmd[1]);
187         if (err)
188                 rq->errors = err;
189         ide_complete_rq(drive, err, blk_rq_bytes(rq));
190         return ide_stopped;
191 }