Commit | Line | Data |
---|---|---|
b2441318 | 1 | // SPDX-License-Identifier: GPL-2.0 |
0127854d BZ |
2 | /* |
3 | * ide-floppy IOCTLs handling. | |
4 | */ | |
5 | ||
6 | #include <linux/kernel.h> | |
7 | #include <linux/ide.h> | |
c103d6ee | 8 | #include <linux/compat.h> |
0127854d | 9 | #include <linux/cdrom.h> |
2a48fc0a | 10 | #include <linux/mutex.h> |
0127854d BZ |
11 | |
12 | #include <asm/unaligned.h> | |
13 | ||
14 | #include <scsi/scsi_ioctl.h> | |
15 | ||
16 | #include "ide-floppy.h" | |
17 | ||
18 | /* | |
19 | * Obtain the list of formattable capacities. | |
20 | * Very similar to ide_floppy_get_capacity, except that we push the capacity | |
21 | * descriptors to userland, instead of our own structures. | |
22 | * | |
23 | * Userland gives us the following structure: | |
24 | * | |
25 | * struct idefloppy_format_capacities { | |
26 | * int nformats; | |
27 | * struct { | |
28 | * int nblocks; | |
29 | * int blocksize; | |
30 | * } formats[]; | |
31 | * }; | |
32 | * | |
33 | * userland initializes nformats to the number of allocated formats[] records. | |
34 | * On exit we set nformats to the number of records we've actually initialized. | |
35 | */ | |
36 | ||
2a48fc0a | 37 | static DEFINE_MUTEX(ide_floppy_ioctl_mutex); |
07bd3f47 LT |
38 | static int ide_floppy_get_format_capacities(ide_drive_t *drive, |
39 | struct ide_atapi_pc *pc, | |
40 | int __user *arg) | |
0127854d | 41 | { |
806f80a6 | 42 | struct ide_disk_obj *floppy = drive->driver_data; |
0127854d BZ |
43 | int i, blocks, length, u_array_size, u_index; |
44 | int __user *argp; | |
41fa9f86 | 45 | u8 pc_buf[256], header_len, desc_cnt; |
0127854d BZ |
46 | |
47 | if (get_user(u_array_size, arg)) | |
48 | return -EFAULT; | |
49 | ||
50 | if (u_array_size <= 0) | |
51 | return -EINVAL; | |
52 | ||
07bd3f47 | 53 | ide_floppy_create_read_capacity_cmd(pc); |
41fa9f86 | 54 | |
b13345f3 | 55 | if (ide_queue_pc_tail(drive, floppy->disk, pc, pc_buf, pc->req_xfer)) { |
0127854d BZ |
56 | printk(KERN_ERR "ide-floppy: Can't get floppy parameters\n"); |
57 | return -EIO; | |
58 | } | |
59 | ||
b13345f3 | 60 | header_len = pc_buf[3]; |
0127854d BZ |
61 | desc_cnt = header_len / 8; /* capacity descriptor of 8 bytes */ |
62 | ||
63 | u_index = 0; | |
64 | argp = arg + 1; | |
65 | ||
66 | /* | |
67 | * We always skip the first capacity descriptor. That's the current | |
68 | * capacity. We are interested in the remaining descriptors, the | |
69 | * formattable capacities. | |
70 | */ | |
71 | for (i = 1; i < desc_cnt; i++) { | |
72 | unsigned int desc_start = 4 + i*8; | |
73 | ||
74 | if (u_index >= u_array_size) | |
75 | break; /* User-supplied buffer too small */ | |
76 | ||
b13345f3 BP |
77 | blocks = be32_to_cpup((__be32 *)&pc_buf[desc_start]); |
78 | length = be16_to_cpup((__be16 *)&pc_buf[desc_start + 6]); | |
0127854d BZ |
79 | |
80 | if (put_user(blocks, argp)) | |
81 | return -EFAULT; | |
82 | ||
83 | ++argp; | |
84 | ||
85 | if (put_user(length, argp)) | |
86 | return -EFAULT; | |
87 | ||
88 | ++argp; | |
89 | ||
90 | ++u_index; | |
91 | } | |
92 | ||
93 | if (put_user(u_index, arg)) | |
94 | return -EFAULT; | |
95 | ||
96 | return 0; | |
97 | } | |
98 | ||
5122e517 BP |
99 | static void ide_floppy_create_format_unit_cmd(struct ide_atapi_pc *pc, |
100 | u8 *buf, int b, int l, | |
101 | int flags) | |
0127854d BZ |
102 | { |
103 | ide_init_pc(pc); | |
104 | pc->c[0] = GPCMD_FORMAT_UNIT; | |
105 | pc->c[1] = 0x17; | |
106 | ||
5122e517 BP |
107 | memset(buf, 0, 12); |
108 | buf[1] = 0xA2; | |
0127854d BZ |
109 | /* Default format list header, u8 1: FOV/DCRT/IMM bits set */ |
110 | ||
111 | if (flags & 1) /* Verify bit on... */ | |
5122e517 BP |
112 | buf[1] ^= 0x20; /* ... turn off DCRT bit */ |
113 | buf[3] = 8; | |
0127854d | 114 | |
5122e517 BP |
115 | put_unaligned(cpu_to_be32(b), (unsigned int *)(&buf[4])); |
116 | put_unaligned(cpu_to_be32(l), (unsigned int *)(&buf[8])); | |
117 | pc->req_xfer = 12; | |
0127854d BZ |
118 | pc->flags |= PC_FLAG_WRITING; |
119 | } | |
120 | ||
07bd3f47 | 121 | static int ide_floppy_get_sfrp_bit(ide_drive_t *drive, struct ide_atapi_pc *pc) |
0127854d | 122 | { |
0df96277 | 123 | struct ide_disk_obj *floppy = drive->driver_data; |
802e6634 | 124 | u8 buf[20]; |
0127854d BZ |
125 | |
126 | drive->atapi_flags &= ~IDE_AFLAG_SRFP; | |
127 | ||
07bd3f47 LT |
128 | ide_floppy_create_mode_sense_cmd(pc, IDEFLOPPY_CAPABILITIES_PAGE); |
129 | pc->flags |= PC_FLAG_SUPPRESS_ERROR; | |
0127854d | 130 | |
802e6634 | 131 | if (ide_queue_pc_tail(drive, floppy->disk, pc, buf, pc->req_xfer)) |
0127854d BZ |
132 | return 1; |
133 | ||
802e6634 | 134 | if (buf[8 + 2] & 0x40) |
0127854d BZ |
135 | drive->atapi_flags |= IDE_AFLAG_SRFP; |
136 | ||
137 | return 0; | |
138 | } | |
139 | ||
07bd3f47 LT |
140 | static int ide_floppy_format_unit(ide_drive_t *drive, struct ide_atapi_pc *pc, |
141 | int __user *arg) | |
0127854d | 142 | { |
0df96277 | 143 | struct ide_disk_obj *floppy = drive->driver_data; |
5122e517 | 144 | u8 buf[12]; |
0127854d BZ |
145 | int blocks, length, flags, err = 0; |
146 | ||
147 | if (floppy->openers > 1) { | |
148 | /* Don't format if someone is using the disk */ | |
e0128628 | 149 | drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS; |
0127854d BZ |
150 | return -EBUSY; |
151 | } | |
152 | ||
e0128628 | 153 | drive->dev_flags |= IDE_DFLAG_FORMAT_IN_PROGRESS; |
0127854d BZ |
154 | |
155 | /* | |
156 | * Send ATAPI_FORMAT_UNIT to the drive. | |
157 | * | |
158 | * Userland gives us the following structure: | |
159 | * | |
160 | * struct idefloppy_format_command { | |
161 | * int nblocks; | |
162 | * int blocksize; | |
163 | * int flags; | |
164 | * } ; | |
165 | * | |
166 | * flags is a bitmask, currently, the only defined flag is: | |
167 | * | |
168 | * 0x01 - verify media after format. | |
169 | */ | |
170 | if (get_user(blocks, arg) || | |
171 | get_user(length, arg+1) || | |
172 | get_user(flags, arg+2)) { | |
173 | err = -EFAULT; | |
174 | goto out; | |
175 | } | |
176 | ||
07bd3f47 | 177 | ide_floppy_get_sfrp_bit(drive, pc); |
5122e517 | 178 | ide_floppy_create_format_unit_cmd(pc, buf, blocks, length, flags); |
0127854d | 179 | |
5122e517 | 180 | if (ide_queue_pc_tail(drive, floppy->disk, pc, buf, pc->req_xfer)) |
0127854d BZ |
181 | err = -EIO; |
182 | ||
183 | out: | |
184 | if (err) | |
e0128628 | 185 | drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS; |
0127854d BZ |
186 | return err; |
187 | } | |
188 | ||
189 | /* | |
190 | * Get ATAPI_FORMAT_UNIT progress indication. | |
191 | * | |
192 | * Userland gives a pointer to an int. The int is set to a progress | |
193 | * indicator 0-65536, with 65536=100%. | |
194 | * | |
195 | * If the drive does not support format progress indication, we just check | |
196 | * the dsc bit, and return either 0 or 65536. | |
197 | */ | |
198 | ||
07bd3f47 LT |
199 | static int ide_floppy_get_format_progress(ide_drive_t *drive, |
200 | struct ide_atapi_pc *pc, | |
201 | int __user *arg) | |
0127854d | 202 | { |
0df96277 | 203 | struct ide_disk_obj *floppy = drive->driver_data; |
60cfab85 | 204 | u8 sense_buf[18]; |
0127854d BZ |
205 | int progress_indication = 0x10000; |
206 | ||
207 | if (drive->atapi_flags & IDE_AFLAG_SRFP) { | |
07bd3f47 | 208 | ide_create_request_sense_cmd(drive, pc); |
60cfab85 | 209 | if (ide_queue_pc_tail(drive, floppy->disk, pc, sense_buf, |
b13345f3 | 210 | pc->req_xfer)) |
0127854d BZ |
211 | return -EIO; |
212 | ||
213 | if (floppy->sense_key == 2 && | |
214 | floppy->asc == 4 && | |
215 | floppy->ascq == 4) | |
216 | progress_indication = floppy->progress_indication; | |
217 | ||
218 | /* Else assume format_unit has finished, and we're at 0x10000 */ | |
219 | } else { | |
220 | ide_hwif_t *hwif = drive->hwif; | |
221 | unsigned long flags; | |
222 | u8 stat; | |
223 | ||
224 | local_irq_save(flags); | |
225 | stat = hwif->tp_ops->read_status(hwif); | |
226 | local_irq_restore(flags); | |
227 | ||
228 | progress_indication = ((stat & ATA_DSC) == 0) ? 0 : 0x10000; | |
229 | } | |
230 | ||
231 | if (put_user(progress_indication, arg)) | |
232 | return -EFAULT; | |
233 | ||
234 | return 0; | |
235 | } | |
236 | ||
5bb1536a BZ |
237 | static int ide_floppy_lockdoor(ide_drive_t *drive, struct ide_atapi_pc *pc, |
238 | unsigned long arg, unsigned int cmd) | |
239 | { | |
0df96277 | 240 | struct ide_disk_obj *floppy = drive->driver_data; |
5bb1536a BZ |
241 | struct gendisk *disk = floppy->disk; |
242 | int prevent = (arg && cmd != CDROMEJECT) ? 1 : 0; | |
243 | ||
244 | if (floppy->openers > 1) | |
245 | return -EBUSY; | |
246 | ||
247 | ide_set_media_lock(drive, disk, prevent); | |
248 | ||
249 | if (cmd == CDROMEJECT) | |
250 | ide_do_start_stop(drive, disk, 2); | |
251 | ||
252 | return 0; | |
253 | } | |
254 | ||
07bd3f47 LT |
255 | static int ide_floppy_format_ioctl(ide_drive_t *drive, struct ide_atapi_pc *pc, |
256 | fmode_t mode, unsigned int cmd, | |
257 | void __user *argp) | |
0127854d BZ |
258 | { |
259 | switch (cmd) { | |
260 | case IDEFLOPPY_IOCTL_FORMAT_SUPPORTED: | |
261 | return 0; | |
262 | case IDEFLOPPY_IOCTL_FORMAT_GET_CAPACITY: | |
07bd3f47 | 263 | return ide_floppy_get_format_capacities(drive, pc, argp); |
0127854d | 264 | case IDEFLOPPY_IOCTL_FORMAT_START: |
badf8082 | 265 | if (!(mode & FMODE_WRITE)) |
0127854d | 266 | return -EPERM; |
07bd3f47 | 267 | return ide_floppy_format_unit(drive, pc, (int __user *)argp); |
0127854d | 268 | case IDEFLOPPY_IOCTL_FORMAT_GET_PROGRESS: |
07bd3f47 | 269 | return ide_floppy_get_format_progress(drive, pc, argp); |
0127854d BZ |
270 | default: |
271 | return -ENOTTY; | |
272 | } | |
273 | } | |
5bb1536a | 274 | |
badf8082 AV |
275 | int ide_floppy_ioctl(ide_drive_t *drive, struct block_device *bdev, |
276 | fmode_t mode, unsigned int cmd, unsigned long arg) | |
5bb1536a | 277 | { |
5bb1536a BZ |
278 | struct ide_atapi_pc pc; |
279 | void __user *argp = (void __user *)arg; | |
280 | int err; | |
281 | ||
2a48fc0a | 282 | mutex_lock(&ide_floppy_ioctl_mutex); |
8a6cfeb6 AB |
283 | if (cmd == CDROMEJECT || cmd == CDROM_LOCKDOOR) { |
284 | err = ide_floppy_lockdoor(drive, &pc, arg, cmd); | |
285 | goto out; | |
286 | } | |
5bb1536a | 287 | |
07bd3f47 | 288 | err = ide_floppy_format_ioctl(drive, &pc, mode, cmd, argp); |
5bb1536a | 289 | if (err != -ENOTTY) |
8a6cfeb6 | 290 | goto out; |
5bb1536a BZ |
291 | |
292 | /* | |
293 | * skip SCSI_IOCTL_SEND_COMMAND (deprecated) | |
294 | * and CDROM_SEND_PACKET (legacy) ioctls | |
295 | */ | |
296 | if (cmd != CDROM_SEND_PACKET && cmd != SCSI_IOCTL_SEND_COMMAND) | |
577ebb37 | 297 | err = scsi_cmd_blk_ioctl(bdev, mode, cmd, argp); |
5bb1536a BZ |
298 | |
299 | if (err == -ENOTTY) | |
1bddd9e6 | 300 | err = generic_ide_ioctl(drive, bdev, cmd, arg); |
5bb1536a | 301 | |
8a6cfeb6 | 302 | out: |
2a48fc0a | 303 | mutex_unlock(&ide_floppy_ioctl_mutex); |
5bb1536a BZ |
304 | return err; |
305 | } | |
c103d6ee AB |
306 | |
307 | #ifdef CONFIG_COMPAT | |
308 | int ide_floppy_compat_ioctl(ide_drive_t *drive, struct block_device *bdev, | |
309 | fmode_t mode, unsigned int cmd, unsigned long arg) | |
310 | { | |
311 | struct ide_atapi_pc pc; | |
312 | void __user *argp = compat_ptr(arg); | |
313 | int err; | |
314 | ||
315 | mutex_lock(&ide_floppy_ioctl_mutex); | |
316 | if (cmd == CDROMEJECT || cmd == CDROM_LOCKDOOR) { | |
317 | err = ide_floppy_lockdoor(drive, &pc, arg, cmd); | |
318 | goto out; | |
319 | } | |
320 | ||
321 | err = ide_floppy_format_ioctl(drive, &pc, mode, cmd, argp); | |
322 | if (err != -ENOTTY) | |
323 | goto out; | |
324 | ||
325 | /* | |
326 | * skip SCSI_IOCTL_SEND_COMMAND (deprecated) | |
327 | * and CDROM_SEND_PACKET (legacy) ioctls | |
328 | */ | |
329 | if (cmd != CDROM_SEND_PACKET && cmd != SCSI_IOCTL_SEND_COMMAND) | |
330 | err = scsi_cmd_blk_ioctl(bdev, mode, cmd, argp); | |
331 | ||
1df23c6f AB |
332 | if (err == -ENOTTY) |
333 | err = generic_ide_ioctl(drive, bdev, cmd, arg); | |
334 | ||
c103d6ee AB |
335 | out: |
336 | mutex_unlock(&ide_floppy_ioctl_mutex); | |
337 | return err; | |
338 | } | |
339 | #endif |