This source file includes following definitions.
- sd_set_flush_flag
- cache_type_store
- manage_start_stop_show
- manage_start_stop_store
- allow_restart_show
- allow_restart_store
- cache_type_show
- FUA_show
- protection_type_show
- protection_type_store
- protection_mode_show
- app_tag_own_show
- thin_provisioning_show
- provisioning_mode_show
- provisioning_mode_store
- zeroing_mode_show
- zeroing_mode_store
- max_medium_access_timeouts_show
- max_medium_access_timeouts_store
- max_write_same_blocks_show
- max_write_same_blocks_store
- sd_default_probe
- sd_major
- scsi_disk_get
- scsi_disk_put
- sd_sec_submit
- sd_prot_op
- sd_prot_flag_mask
- sd_setup_protect_cmnd
- sd_config_discard
- sd_setup_unmap_cmnd
- sd_setup_write_same16_cmnd
- sd_setup_write_same10_cmnd
- sd_setup_write_zeroes_cmnd
- sd_config_write_same
- sd_setup_write_same_cmnd
- sd_setup_flush_cmnd
- sd_setup_rw32_cmnd
- sd_setup_rw16_cmnd
- sd_setup_rw10_cmnd
- sd_setup_rw6_cmnd
- sd_setup_read_write_cmnd
- sd_init_command
- sd_uninit_command
- sd_open
- sd_release
- sd_getgeo
- sd_ioctl
- set_media_not_present
- media_not_present
- sd_check_events
- sd_sync_cache
- sd_rescan
- sd_compat_ioctl
- sd_pr_type
- sd_pr_command
- sd_pr_register
- sd_pr_reserve
- sd_pr_release
- sd_pr_preempt
- sd_pr_clear
- sd_eh_reset
- sd_eh_action
- sd_completed_bytes
- sd_done
- sd_spinup_disk
- sd_read_protection_type
- read_capacity_error
- read_capacity_16
- read_capacity_10
- sd_try_rc16_first
- sd_read_capacity
- sd_print_capacity
- sd_do_mode_sense
- sd_read_write_protect_flag
- sd_read_cache_type
- sd_read_app_tag_own
- sd_read_block_limits
- sd_read_block_characteristics
- sd_read_block_provisioning
- sd_read_write_same
- sd_read_security
- sd_validate_opt_xfer_size
- sd_revalidate_disk
- sd_unlock_native_capacity
- sd_format_disk_name
- sd_probe
- sd_remove
- scsi_disk_release
- sd_start_stop_device
- sd_shutdown
- sd_suspend_common
- sd_suspend_system
- sd_suspend_runtime
- sd_resume
- init_sd
- exit_sd
- sd_print_sense_hdr
- sd_print_result
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36 #include <linux/module.h>
37 #include <linux/fs.h>
38 #include <linux/kernel.h>
39 #include <linux/mm.h>
40 #include <linux/bio.h>
41 #include <linux/genhd.h>
42 #include <linux/hdreg.h>
43 #include <linux/errno.h>
44 #include <linux/idr.h>
45 #include <linux/interrupt.h>
46 #include <linux/init.h>
47 #include <linux/blkdev.h>
48 #include <linux/blkpg.h>
49 #include <linux/blk-pm.h>
50 #include <linux/delay.h>
51 #include <linux/mutex.h>
52 #include <linux/string_helpers.h>
53 #include <linux/async.h>
54 #include <linux/slab.h>
55 #include <linux/sed-opal.h>
56 #include <linux/pm_runtime.h>
57 #include <linux/pr.h>
58 #include <linux/t10-pi.h>
59 #include <linux/uaccess.h>
60 #include <asm/unaligned.h>
61
62 #include <scsi/scsi.h>
63 #include <scsi/scsi_cmnd.h>
64 #include <scsi/scsi_dbg.h>
65 #include <scsi/scsi_device.h>
66 #include <scsi/scsi_driver.h>
67 #include <scsi/scsi_eh.h>
68 #include <scsi/scsi_host.h>
69 #include <scsi/scsi_ioctl.h>
70 #include <scsi/scsicam.h>
71
72 #include "sd.h"
73 #include "scsi_priv.h"
74 #include "scsi_logging.h"
75
76 MODULE_AUTHOR("Eric Youngdale");
77 MODULE_DESCRIPTION("SCSI disk (sd) driver");
78 MODULE_LICENSE("GPL");
79
80 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK0_MAJOR);
81 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK1_MAJOR);
82 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK2_MAJOR);
83 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK3_MAJOR);
84 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK4_MAJOR);
85 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK5_MAJOR);
86 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK6_MAJOR);
87 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK7_MAJOR);
88 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK8_MAJOR);
89 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK9_MAJOR);
90 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK10_MAJOR);
91 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK11_MAJOR);
92 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK12_MAJOR);
93 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK13_MAJOR);
94 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK14_MAJOR);
95 MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK15_MAJOR);
96 MODULE_ALIAS_SCSI_DEVICE(TYPE_DISK);
97 MODULE_ALIAS_SCSI_DEVICE(TYPE_MOD);
98 MODULE_ALIAS_SCSI_DEVICE(TYPE_RBC);
99 MODULE_ALIAS_SCSI_DEVICE(TYPE_ZBC);
100
101 #if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
102 #define SD_MINORS 16
103 #else
104 #define SD_MINORS 0
105 #endif
106
107 static void sd_config_discard(struct scsi_disk *, unsigned int);
108 static void sd_config_write_same(struct scsi_disk *);
109 static int sd_revalidate_disk(struct gendisk *);
110 static void sd_unlock_native_capacity(struct gendisk *disk);
111 static int sd_probe(struct device *);
112 static int sd_remove(struct device *);
113 static void sd_shutdown(struct device *);
114 static int sd_suspend_system(struct device *);
115 static int sd_suspend_runtime(struct device *);
116 static int sd_resume(struct device *);
117 static void sd_rescan(struct device *);
118 static blk_status_t sd_init_command(struct scsi_cmnd *SCpnt);
119 static void sd_uninit_command(struct scsi_cmnd *SCpnt);
120 static int sd_done(struct scsi_cmnd *);
121 static void sd_eh_reset(struct scsi_cmnd *);
122 static int sd_eh_action(struct scsi_cmnd *, int);
123 static void sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer);
124 static void scsi_disk_release(struct device *cdev);
125 static void sd_print_sense_hdr(struct scsi_disk *, struct scsi_sense_hdr *);
126 static void sd_print_result(const struct scsi_disk *, const char *, int);
127
128 static DEFINE_IDA(sd_index_ida);
129
130
131
132
133 static DEFINE_MUTEX(sd_ref_mutex);
134
135 static struct kmem_cache *sd_cdb_cache;
136 static mempool_t *sd_cdb_pool;
137 static mempool_t *sd_page_pool;
138
139 static const char *sd_cache_types[] = {
140 "write through", "none", "write back",
141 "write back, no read (daft)"
142 };
143
144 static void sd_set_flush_flag(struct scsi_disk *sdkp)
145 {
146 bool wc = false, fua = false;
147
148 if (sdkp->WCE) {
149 wc = true;
150 if (sdkp->DPOFUA)
151 fua = true;
152 }
153
154 blk_queue_write_cache(sdkp->disk->queue, wc, fua);
155 }
156
157 static ssize_t
158 cache_type_store(struct device *dev, struct device_attribute *attr,
159 const char *buf, size_t count)
160 {
161 int ct, rcd, wce, sp;
162 struct scsi_disk *sdkp = to_scsi_disk(dev);
163 struct scsi_device *sdp = sdkp->device;
164 char buffer[64];
165 char *buffer_data;
166 struct scsi_mode_data data;
167 struct scsi_sense_hdr sshdr;
168 static const char temp[] = "temporary ";
169 int len;
170
171 if (sdp->type != TYPE_DISK && sdp->type != TYPE_ZBC)
172
173
174
175 return -EINVAL;
176
177 if (strncmp(buf, temp, sizeof(temp) - 1) == 0) {
178 buf += sizeof(temp) - 1;
179 sdkp->cache_override = 1;
180 } else {
181 sdkp->cache_override = 0;
182 }
183
184 ct = sysfs_match_string(sd_cache_types, buf);
185 if (ct < 0)
186 return -EINVAL;
187
188 rcd = ct & 0x01 ? 1 : 0;
189 wce = (ct & 0x02) && !sdkp->write_prot ? 1 : 0;
190
191 if (sdkp->cache_override) {
192 sdkp->WCE = wce;
193 sdkp->RCD = rcd;
194 sd_set_flush_flag(sdkp);
195 return count;
196 }
197
198 if (scsi_mode_sense(sdp, 0x08, 8, buffer, sizeof(buffer), SD_TIMEOUT,
199 SD_MAX_RETRIES, &data, NULL))
200 return -EINVAL;
201 len = min_t(size_t, sizeof(buffer), data.length - data.header_length -
202 data.block_descriptor_length);
203 buffer_data = buffer + data.header_length +
204 data.block_descriptor_length;
205 buffer_data[2] &= ~0x05;
206 buffer_data[2] |= wce << 2 | rcd;
207 sp = buffer_data[0] & 0x80 ? 1 : 0;
208 buffer_data[0] &= ~0x80;
209
210
211
212
213
214 data.device_specific = 0;
215
216 if (scsi_mode_select(sdp, 1, sp, 8, buffer_data, len, SD_TIMEOUT,
217 SD_MAX_RETRIES, &data, &sshdr)) {
218 if (scsi_sense_valid(&sshdr))
219 sd_print_sense_hdr(sdkp, &sshdr);
220 return -EINVAL;
221 }
222 revalidate_disk(sdkp->disk);
223 return count;
224 }
225
226 static ssize_t
227 manage_start_stop_show(struct device *dev, struct device_attribute *attr,
228 char *buf)
229 {
230 struct scsi_disk *sdkp = to_scsi_disk(dev);
231 struct scsi_device *sdp = sdkp->device;
232
233 return sprintf(buf, "%u\n", sdp->manage_start_stop);
234 }
235
236 static ssize_t
237 manage_start_stop_store(struct device *dev, struct device_attribute *attr,
238 const char *buf, size_t count)
239 {
240 struct scsi_disk *sdkp = to_scsi_disk(dev);
241 struct scsi_device *sdp = sdkp->device;
242 bool v;
243
244 if (!capable(CAP_SYS_ADMIN))
245 return -EACCES;
246
247 if (kstrtobool(buf, &v))
248 return -EINVAL;
249
250 sdp->manage_start_stop = v;
251
252 return count;
253 }
254 static DEVICE_ATTR_RW(manage_start_stop);
255
256 static ssize_t
257 allow_restart_show(struct device *dev, struct device_attribute *attr, char *buf)
258 {
259 struct scsi_disk *sdkp = to_scsi_disk(dev);
260
261 return sprintf(buf, "%u\n", sdkp->device->allow_restart);
262 }
263
264 static ssize_t
265 allow_restart_store(struct device *dev, struct device_attribute *attr,
266 const char *buf, size_t count)
267 {
268 bool v;
269 struct scsi_disk *sdkp = to_scsi_disk(dev);
270 struct scsi_device *sdp = sdkp->device;
271
272 if (!capable(CAP_SYS_ADMIN))
273 return -EACCES;
274
275 if (sdp->type != TYPE_DISK && sdp->type != TYPE_ZBC)
276 return -EINVAL;
277
278 if (kstrtobool(buf, &v))
279 return -EINVAL;
280
281 sdp->allow_restart = v;
282
283 return count;
284 }
285 static DEVICE_ATTR_RW(allow_restart);
286
287 static ssize_t
288 cache_type_show(struct device *dev, struct device_attribute *attr, char *buf)
289 {
290 struct scsi_disk *sdkp = to_scsi_disk(dev);
291 int ct = sdkp->RCD + 2*sdkp->WCE;
292
293 return sprintf(buf, "%s\n", sd_cache_types[ct]);
294 }
295 static DEVICE_ATTR_RW(cache_type);
296
297 static ssize_t
298 FUA_show(struct device *dev, struct device_attribute *attr, char *buf)
299 {
300 struct scsi_disk *sdkp = to_scsi_disk(dev);
301
302 return sprintf(buf, "%u\n", sdkp->DPOFUA);
303 }
304 static DEVICE_ATTR_RO(FUA);
305
306 static ssize_t
307 protection_type_show(struct device *dev, struct device_attribute *attr,
308 char *buf)
309 {
310 struct scsi_disk *sdkp = to_scsi_disk(dev);
311
312 return sprintf(buf, "%u\n", sdkp->protection_type);
313 }
314
315 static ssize_t
316 protection_type_store(struct device *dev, struct device_attribute *attr,
317 const char *buf, size_t count)
318 {
319 struct scsi_disk *sdkp = to_scsi_disk(dev);
320 unsigned int val;
321 int err;
322
323 if (!capable(CAP_SYS_ADMIN))
324 return -EACCES;
325
326 err = kstrtouint(buf, 10, &val);
327
328 if (err)
329 return err;
330
331 if (val <= T10_PI_TYPE3_PROTECTION)
332 sdkp->protection_type = val;
333
334 return count;
335 }
336 static DEVICE_ATTR_RW(protection_type);
337
338 static ssize_t
339 protection_mode_show(struct device *dev, struct device_attribute *attr,
340 char *buf)
341 {
342 struct scsi_disk *sdkp = to_scsi_disk(dev);
343 struct scsi_device *sdp = sdkp->device;
344 unsigned int dif, dix;
345
346 dif = scsi_host_dif_capable(sdp->host, sdkp->protection_type);
347 dix = scsi_host_dix_capable(sdp->host, sdkp->protection_type);
348
349 if (!dix && scsi_host_dix_capable(sdp->host, T10_PI_TYPE0_PROTECTION)) {
350 dif = 0;
351 dix = 1;
352 }
353
354 if (!dif && !dix)
355 return sprintf(buf, "none\n");
356
357 return sprintf(buf, "%s%u\n", dix ? "dix" : "dif", dif);
358 }
359 static DEVICE_ATTR_RO(protection_mode);
360
361 static ssize_t
362 app_tag_own_show(struct device *dev, struct device_attribute *attr, char *buf)
363 {
364 struct scsi_disk *sdkp = to_scsi_disk(dev);
365
366 return sprintf(buf, "%u\n", sdkp->ATO);
367 }
368 static DEVICE_ATTR_RO(app_tag_own);
369
370 static ssize_t
371 thin_provisioning_show(struct device *dev, struct device_attribute *attr,
372 char *buf)
373 {
374 struct scsi_disk *sdkp = to_scsi_disk(dev);
375
376 return sprintf(buf, "%u\n", sdkp->lbpme);
377 }
378 static DEVICE_ATTR_RO(thin_provisioning);
379
380
381 static const char *lbp_mode[] = {
382 [SD_LBP_FULL] = "full",
383 [SD_LBP_UNMAP] = "unmap",
384 [SD_LBP_WS16] = "writesame_16",
385 [SD_LBP_WS10] = "writesame_10",
386 [SD_LBP_ZERO] = "writesame_zero",
387 [SD_LBP_DISABLE] = "disabled",
388 };
389
390 static ssize_t
391 provisioning_mode_show(struct device *dev, struct device_attribute *attr,
392 char *buf)
393 {
394 struct scsi_disk *sdkp = to_scsi_disk(dev);
395
396 return sprintf(buf, "%s\n", lbp_mode[sdkp->provisioning_mode]);
397 }
398
399 static ssize_t
400 provisioning_mode_store(struct device *dev, struct device_attribute *attr,
401 const char *buf, size_t count)
402 {
403 struct scsi_disk *sdkp = to_scsi_disk(dev);
404 struct scsi_device *sdp = sdkp->device;
405 int mode;
406
407 if (!capable(CAP_SYS_ADMIN))
408 return -EACCES;
409
410 if (sd_is_zoned(sdkp)) {
411 sd_config_discard(sdkp, SD_LBP_DISABLE);
412 return count;
413 }
414
415 if (sdp->type != TYPE_DISK)
416 return -EINVAL;
417
418 mode = sysfs_match_string(lbp_mode, buf);
419 if (mode < 0)
420 return -EINVAL;
421
422 sd_config_discard(sdkp, mode);
423
424 return count;
425 }
426 static DEVICE_ATTR_RW(provisioning_mode);
427
428
429 static const char *zeroing_mode[] = {
430 [SD_ZERO_WRITE] = "write",
431 [SD_ZERO_WS] = "writesame",
432 [SD_ZERO_WS16_UNMAP] = "writesame_16_unmap",
433 [SD_ZERO_WS10_UNMAP] = "writesame_10_unmap",
434 };
435
436 static ssize_t
437 zeroing_mode_show(struct device *dev, struct device_attribute *attr,
438 char *buf)
439 {
440 struct scsi_disk *sdkp = to_scsi_disk(dev);
441
442 return sprintf(buf, "%s\n", zeroing_mode[sdkp->zeroing_mode]);
443 }
444
445 static ssize_t
446 zeroing_mode_store(struct device *dev, struct device_attribute *attr,
447 const char *buf, size_t count)
448 {
449 struct scsi_disk *sdkp = to_scsi_disk(dev);
450 int mode;
451
452 if (!capable(CAP_SYS_ADMIN))
453 return -EACCES;
454
455 mode = sysfs_match_string(zeroing_mode, buf);
456 if (mode < 0)
457 return -EINVAL;
458
459 sdkp->zeroing_mode = mode;
460
461 return count;
462 }
463 static DEVICE_ATTR_RW(zeroing_mode);
464
465 static ssize_t
466 max_medium_access_timeouts_show(struct device *dev,
467 struct device_attribute *attr, char *buf)
468 {
469 struct scsi_disk *sdkp = to_scsi_disk(dev);
470
471 return sprintf(buf, "%u\n", sdkp->max_medium_access_timeouts);
472 }
473
474 static ssize_t
475 max_medium_access_timeouts_store(struct device *dev,
476 struct device_attribute *attr, const char *buf,
477 size_t count)
478 {
479 struct scsi_disk *sdkp = to_scsi_disk(dev);
480 int err;
481
482 if (!capable(CAP_SYS_ADMIN))
483 return -EACCES;
484
485 err = kstrtouint(buf, 10, &sdkp->max_medium_access_timeouts);
486
487 return err ? err : count;
488 }
489 static DEVICE_ATTR_RW(max_medium_access_timeouts);
490
491 static ssize_t
492 max_write_same_blocks_show(struct device *dev, struct device_attribute *attr,
493 char *buf)
494 {
495 struct scsi_disk *sdkp = to_scsi_disk(dev);
496
497 return sprintf(buf, "%u\n", sdkp->max_ws_blocks);
498 }
499
500 static ssize_t
501 max_write_same_blocks_store(struct device *dev, struct device_attribute *attr,
502 const char *buf, size_t count)
503 {
504 struct scsi_disk *sdkp = to_scsi_disk(dev);
505 struct scsi_device *sdp = sdkp->device;
506 unsigned long max;
507 int err;
508
509 if (!capable(CAP_SYS_ADMIN))
510 return -EACCES;
511
512 if (sdp->type != TYPE_DISK && sdp->type != TYPE_ZBC)
513 return -EINVAL;
514
515 err = kstrtoul(buf, 10, &max);
516
517 if (err)
518 return err;
519
520 if (max == 0)
521 sdp->no_write_same = 1;
522 else if (max <= SD_MAX_WS16_BLOCKS) {
523 sdp->no_write_same = 0;
524 sdkp->max_ws_blocks = max;
525 }
526
527 sd_config_write_same(sdkp);
528
529 return count;
530 }
531 static DEVICE_ATTR_RW(max_write_same_blocks);
532
533 static struct attribute *sd_disk_attrs[] = {
534 &dev_attr_cache_type.attr,
535 &dev_attr_FUA.attr,
536 &dev_attr_allow_restart.attr,
537 &dev_attr_manage_start_stop.attr,
538 &dev_attr_protection_type.attr,
539 &dev_attr_protection_mode.attr,
540 &dev_attr_app_tag_own.attr,
541 &dev_attr_thin_provisioning.attr,
542 &dev_attr_provisioning_mode.attr,
543 &dev_attr_zeroing_mode.attr,
544 &dev_attr_max_write_same_blocks.attr,
545 &dev_attr_max_medium_access_timeouts.attr,
546 NULL,
547 };
548 ATTRIBUTE_GROUPS(sd_disk);
549
550 static struct class sd_disk_class = {
551 .name = "scsi_disk",
552 .owner = THIS_MODULE,
553 .dev_release = scsi_disk_release,
554 .dev_groups = sd_disk_groups,
555 };
556
557 static const struct dev_pm_ops sd_pm_ops = {
558 .suspend = sd_suspend_system,
559 .resume = sd_resume,
560 .poweroff = sd_suspend_system,
561 .restore = sd_resume,
562 .runtime_suspend = sd_suspend_runtime,
563 .runtime_resume = sd_resume,
564 };
565
566 static struct scsi_driver sd_template = {
567 .gendrv = {
568 .name = "sd",
569 .owner = THIS_MODULE,
570 .probe = sd_probe,
571 .probe_type = PROBE_PREFER_ASYNCHRONOUS,
572 .remove = sd_remove,
573 .shutdown = sd_shutdown,
574 .pm = &sd_pm_ops,
575 },
576 .rescan = sd_rescan,
577 .init_command = sd_init_command,
578 .uninit_command = sd_uninit_command,
579 .done = sd_done,
580 .eh_action = sd_eh_action,
581 .eh_reset = sd_eh_reset,
582 };
583
584
585
586
587
588
589 static struct kobject *sd_default_probe(dev_t devt, int *partno, void *data)
590 {
591 return NULL;
592 }
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608 static int sd_major(int major_idx)
609 {
610 switch (major_idx) {
611 case 0:
612 return SCSI_DISK0_MAJOR;
613 case 1 ... 7:
614 return SCSI_DISK1_MAJOR + major_idx - 1;
615 case 8 ... 15:
616 return SCSI_DISK8_MAJOR + major_idx - 8;
617 default:
618 BUG();
619 return 0;
620 }
621 }
622
623 static struct scsi_disk *scsi_disk_get(struct gendisk *disk)
624 {
625 struct scsi_disk *sdkp = NULL;
626
627 mutex_lock(&sd_ref_mutex);
628
629 if (disk->private_data) {
630 sdkp = scsi_disk(disk);
631 if (scsi_device_get(sdkp->device) == 0)
632 get_device(&sdkp->dev);
633 else
634 sdkp = NULL;
635 }
636 mutex_unlock(&sd_ref_mutex);
637 return sdkp;
638 }
639
640 static void scsi_disk_put(struct scsi_disk *sdkp)
641 {
642 struct scsi_device *sdev = sdkp->device;
643
644 mutex_lock(&sd_ref_mutex);
645 put_device(&sdkp->dev);
646 scsi_device_put(sdev);
647 mutex_unlock(&sd_ref_mutex);
648 }
649
650 #ifdef CONFIG_BLK_SED_OPAL
651 static int sd_sec_submit(void *data, u16 spsp, u8 secp, void *buffer,
652 size_t len, bool send)
653 {
654 struct scsi_device *sdev = data;
655 u8 cdb[12] = { 0, };
656 int ret;
657
658 cdb[0] = send ? SECURITY_PROTOCOL_OUT : SECURITY_PROTOCOL_IN;
659 cdb[1] = secp;
660 put_unaligned_be16(spsp, &cdb[2]);
661 put_unaligned_be32(len, &cdb[6]);
662
663 ret = scsi_execute_req(sdev, cdb,
664 send ? DMA_TO_DEVICE : DMA_FROM_DEVICE,
665 buffer, len, NULL, SD_TIMEOUT, SD_MAX_RETRIES, NULL);
666 return ret <= 0 ? ret : -EIO;
667 }
668 #endif
669
670
671
672
673
674 static unsigned int sd_prot_op(bool write, bool dix, bool dif)
675 {
676
677 static const unsigned int ops[] = {
678 SCSI_PROT_NORMAL,
679 SCSI_PROT_READ_STRIP,
680 SCSI_PROT_READ_INSERT,
681 SCSI_PROT_READ_PASS,
682 SCSI_PROT_NORMAL,
683 SCSI_PROT_WRITE_INSERT,
684 SCSI_PROT_WRITE_STRIP,
685 SCSI_PROT_WRITE_PASS,
686 };
687
688 return ops[write << 2 | dix << 1 | dif];
689 }
690
691
692
693
694
695 static unsigned int sd_prot_flag_mask(unsigned int prot_op)
696 {
697 static const unsigned int flag_mask[] = {
698 [SCSI_PROT_NORMAL] = 0,
699
700 [SCSI_PROT_READ_STRIP] = SCSI_PROT_TRANSFER_PI |
701 SCSI_PROT_GUARD_CHECK |
702 SCSI_PROT_REF_CHECK |
703 SCSI_PROT_REF_INCREMENT,
704
705 [SCSI_PROT_READ_INSERT] = SCSI_PROT_REF_INCREMENT |
706 SCSI_PROT_IP_CHECKSUM,
707
708 [SCSI_PROT_READ_PASS] = SCSI_PROT_TRANSFER_PI |
709 SCSI_PROT_GUARD_CHECK |
710 SCSI_PROT_REF_CHECK |
711 SCSI_PROT_REF_INCREMENT |
712 SCSI_PROT_IP_CHECKSUM,
713
714 [SCSI_PROT_WRITE_INSERT] = SCSI_PROT_TRANSFER_PI |
715 SCSI_PROT_REF_INCREMENT,
716
717 [SCSI_PROT_WRITE_STRIP] = SCSI_PROT_GUARD_CHECK |
718 SCSI_PROT_REF_CHECK |
719 SCSI_PROT_REF_INCREMENT |
720 SCSI_PROT_IP_CHECKSUM,
721
722 [SCSI_PROT_WRITE_PASS] = SCSI_PROT_TRANSFER_PI |
723 SCSI_PROT_GUARD_CHECK |
724 SCSI_PROT_REF_CHECK |
725 SCSI_PROT_REF_INCREMENT |
726 SCSI_PROT_IP_CHECKSUM,
727 };
728
729 return flag_mask[prot_op];
730 }
731
732 static unsigned char sd_setup_protect_cmnd(struct scsi_cmnd *scmd,
733 unsigned int dix, unsigned int dif)
734 {
735 struct bio *bio = scmd->request->bio;
736 unsigned int prot_op = sd_prot_op(rq_data_dir(scmd->request), dix, dif);
737 unsigned int protect = 0;
738
739 if (dix) {
740 if (bio_integrity_flagged(bio, BIP_IP_CHECKSUM))
741 scmd->prot_flags |= SCSI_PROT_IP_CHECKSUM;
742
743 if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
744 scmd->prot_flags |= SCSI_PROT_GUARD_CHECK;
745 }
746
747 if (dif != T10_PI_TYPE3_PROTECTION) {
748 scmd->prot_flags |= SCSI_PROT_REF_INCREMENT;
749
750 if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
751 scmd->prot_flags |= SCSI_PROT_REF_CHECK;
752 }
753
754 if (dif) {
755 scmd->prot_flags |= SCSI_PROT_TRANSFER_PI;
756
757 if (bio_integrity_flagged(bio, BIP_DISK_NOCHECK))
758 protect = 3 << 5;
759 else
760 protect = 1 << 5;
761 }
762
763 scsi_set_prot_op(scmd, prot_op);
764 scsi_set_prot_type(scmd, dif);
765 scmd->prot_flags &= sd_prot_flag_mask(prot_op);
766
767 return protect;
768 }
769
770 static void sd_config_discard(struct scsi_disk *sdkp, unsigned int mode)
771 {
772 struct request_queue *q = sdkp->disk->queue;
773 unsigned int logical_block_size = sdkp->device->sector_size;
774 unsigned int max_blocks = 0;
775
776 q->limits.discard_alignment =
777 sdkp->unmap_alignment * logical_block_size;
778 q->limits.discard_granularity =
779 max(sdkp->physical_block_size,
780 sdkp->unmap_granularity * logical_block_size);
781 sdkp->provisioning_mode = mode;
782
783 switch (mode) {
784
785 case SD_LBP_FULL:
786 case SD_LBP_DISABLE:
787 blk_queue_max_discard_sectors(q, 0);
788 blk_queue_flag_clear(QUEUE_FLAG_DISCARD, q);
789 return;
790
791 case SD_LBP_UNMAP:
792 max_blocks = min_not_zero(sdkp->max_unmap_blocks,
793 (u32)SD_MAX_WS16_BLOCKS);
794 break;
795
796 case SD_LBP_WS16:
797 if (sdkp->device->unmap_limit_for_ws)
798 max_blocks = sdkp->max_unmap_blocks;
799 else
800 max_blocks = sdkp->max_ws_blocks;
801
802 max_blocks = min_not_zero(max_blocks, (u32)SD_MAX_WS16_BLOCKS);
803 break;
804
805 case SD_LBP_WS10:
806 if (sdkp->device->unmap_limit_for_ws)
807 max_blocks = sdkp->max_unmap_blocks;
808 else
809 max_blocks = sdkp->max_ws_blocks;
810
811 max_blocks = min_not_zero(max_blocks, (u32)SD_MAX_WS10_BLOCKS);
812 break;
813
814 case SD_LBP_ZERO:
815 max_blocks = min_not_zero(sdkp->max_ws_blocks,
816 (u32)SD_MAX_WS10_BLOCKS);
817 break;
818 }
819
820 blk_queue_max_discard_sectors(q, max_blocks * (logical_block_size >> 9));
821 blk_queue_flag_set(QUEUE_FLAG_DISCARD, q);
822 }
823
824 static blk_status_t sd_setup_unmap_cmnd(struct scsi_cmnd *cmd)
825 {
826 struct scsi_device *sdp = cmd->device;
827 struct request *rq = cmd->request;
828 u64 lba = sectors_to_logical(sdp, blk_rq_pos(rq));
829 u32 nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
830 unsigned int data_len = 24;
831 char *buf;
832
833 rq->special_vec.bv_page = mempool_alloc(sd_page_pool, GFP_ATOMIC);
834 if (!rq->special_vec.bv_page)
835 return BLK_STS_RESOURCE;
836 clear_highpage(rq->special_vec.bv_page);
837 rq->special_vec.bv_offset = 0;
838 rq->special_vec.bv_len = data_len;
839 rq->rq_flags |= RQF_SPECIAL_PAYLOAD;
840
841 cmd->cmd_len = 10;
842 cmd->cmnd[0] = UNMAP;
843 cmd->cmnd[8] = 24;
844
845 buf = page_address(rq->special_vec.bv_page);
846 put_unaligned_be16(6 + 16, &buf[0]);
847 put_unaligned_be16(16, &buf[2]);
848 put_unaligned_be64(lba, &buf[8]);
849 put_unaligned_be32(nr_blocks, &buf[16]);
850
851 cmd->allowed = SD_MAX_RETRIES;
852 cmd->transfersize = data_len;
853 rq->timeout = SD_TIMEOUT;
854
855 return scsi_init_io(cmd);
856 }
857
858 static blk_status_t sd_setup_write_same16_cmnd(struct scsi_cmnd *cmd,
859 bool unmap)
860 {
861 struct scsi_device *sdp = cmd->device;
862 struct request *rq = cmd->request;
863 u64 lba = sectors_to_logical(sdp, blk_rq_pos(rq));
864 u32 nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
865 u32 data_len = sdp->sector_size;
866
867 rq->special_vec.bv_page = mempool_alloc(sd_page_pool, GFP_ATOMIC);
868 if (!rq->special_vec.bv_page)
869 return BLK_STS_RESOURCE;
870 clear_highpage(rq->special_vec.bv_page);
871 rq->special_vec.bv_offset = 0;
872 rq->special_vec.bv_len = data_len;
873 rq->rq_flags |= RQF_SPECIAL_PAYLOAD;
874
875 cmd->cmd_len = 16;
876 cmd->cmnd[0] = WRITE_SAME_16;
877 if (unmap)
878 cmd->cmnd[1] = 0x8;
879 put_unaligned_be64(lba, &cmd->cmnd[2]);
880 put_unaligned_be32(nr_blocks, &cmd->cmnd[10]);
881
882 cmd->allowed = SD_MAX_RETRIES;
883 cmd->transfersize = data_len;
884 rq->timeout = unmap ? SD_TIMEOUT : SD_WRITE_SAME_TIMEOUT;
885
886 return scsi_init_io(cmd);
887 }
888
889 static blk_status_t sd_setup_write_same10_cmnd(struct scsi_cmnd *cmd,
890 bool unmap)
891 {
892 struct scsi_device *sdp = cmd->device;
893 struct request *rq = cmd->request;
894 u64 lba = sectors_to_logical(sdp, blk_rq_pos(rq));
895 u32 nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
896 u32 data_len = sdp->sector_size;
897
898 rq->special_vec.bv_page = mempool_alloc(sd_page_pool, GFP_ATOMIC);
899 if (!rq->special_vec.bv_page)
900 return BLK_STS_RESOURCE;
901 clear_highpage(rq->special_vec.bv_page);
902 rq->special_vec.bv_offset = 0;
903 rq->special_vec.bv_len = data_len;
904 rq->rq_flags |= RQF_SPECIAL_PAYLOAD;
905
906 cmd->cmd_len = 10;
907 cmd->cmnd[0] = WRITE_SAME;
908 if (unmap)
909 cmd->cmnd[1] = 0x8;
910 put_unaligned_be32(lba, &cmd->cmnd[2]);
911 put_unaligned_be16(nr_blocks, &cmd->cmnd[7]);
912
913 cmd->allowed = SD_MAX_RETRIES;
914 cmd->transfersize = data_len;
915 rq->timeout = unmap ? SD_TIMEOUT : SD_WRITE_SAME_TIMEOUT;
916
917 return scsi_init_io(cmd);
918 }
919
920 static blk_status_t sd_setup_write_zeroes_cmnd(struct scsi_cmnd *cmd)
921 {
922 struct request *rq = cmd->request;
923 struct scsi_device *sdp = cmd->device;
924 struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
925 u64 lba = sectors_to_logical(sdp, blk_rq_pos(rq));
926 u32 nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
927
928 if (!(rq->cmd_flags & REQ_NOUNMAP)) {
929 switch (sdkp->zeroing_mode) {
930 case SD_ZERO_WS16_UNMAP:
931 return sd_setup_write_same16_cmnd(cmd, true);
932 case SD_ZERO_WS10_UNMAP:
933 return sd_setup_write_same10_cmnd(cmd, true);
934 }
935 }
936
937 if (sdp->no_write_same)
938 return BLK_STS_TARGET;
939
940 if (sdkp->ws16 || lba > 0xffffffff || nr_blocks > 0xffff)
941 return sd_setup_write_same16_cmnd(cmd, false);
942
943 return sd_setup_write_same10_cmnd(cmd, false);
944 }
945
946 static void sd_config_write_same(struct scsi_disk *sdkp)
947 {
948 struct request_queue *q = sdkp->disk->queue;
949 unsigned int logical_block_size = sdkp->device->sector_size;
950
951 if (sdkp->device->no_write_same) {
952 sdkp->max_ws_blocks = 0;
953 goto out;
954 }
955
956
957
958
959
960
961 if (sdkp->max_ws_blocks > SD_MAX_WS10_BLOCKS)
962 sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
963 (u32)SD_MAX_WS16_BLOCKS);
964 else if (sdkp->ws16 || sdkp->ws10 || sdkp->device->no_report_opcodes)
965 sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
966 (u32)SD_MAX_WS10_BLOCKS);
967 else {
968 sdkp->device->no_write_same = 1;
969 sdkp->max_ws_blocks = 0;
970 }
971
972 if (sdkp->lbprz && sdkp->lbpws)
973 sdkp->zeroing_mode = SD_ZERO_WS16_UNMAP;
974 else if (sdkp->lbprz && sdkp->lbpws10)
975 sdkp->zeroing_mode = SD_ZERO_WS10_UNMAP;
976 else if (sdkp->max_ws_blocks)
977 sdkp->zeroing_mode = SD_ZERO_WS;
978 else
979 sdkp->zeroing_mode = SD_ZERO_WRITE;
980
981 if (sdkp->max_ws_blocks &&
982 sdkp->physical_block_size > logical_block_size) {
983
984
985
986
987
988
989
990
991
992
993
994
995 sdkp->max_ws_blocks =
996 round_down(sdkp->max_ws_blocks,
997 bytes_to_logical(sdkp->device,
998 sdkp->physical_block_size));
999 }
1000
1001 out:
1002 blk_queue_max_write_same_sectors(q, sdkp->max_ws_blocks *
1003 (logical_block_size >> 9));
1004 blk_queue_max_write_zeroes_sectors(q, sdkp->max_ws_blocks *
1005 (logical_block_size >> 9));
1006 }
1007
1008
1009
1010
1011
1012
1013
1014
1015 static blk_status_t sd_setup_write_same_cmnd(struct scsi_cmnd *cmd)
1016 {
1017 struct request *rq = cmd->request;
1018 struct scsi_device *sdp = cmd->device;
1019 struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
1020 struct bio *bio = rq->bio;
1021 u64 lba = sectors_to_logical(sdp, blk_rq_pos(rq));
1022 u32 nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
1023 blk_status_t ret;
1024
1025 if (sdkp->device->no_write_same)
1026 return BLK_STS_TARGET;
1027
1028 BUG_ON(bio_offset(bio) || bio_iovec(bio).bv_len != sdp->sector_size);
1029
1030 rq->timeout = SD_WRITE_SAME_TIMEOUT;
1031
1032 if (sdkp->ws16 || lba > 0xffffffff || nr_blocks > 0xffff) {
1033 cmd->cmd_len = 16;
1034 cmd->cmnd[0] = WRITE_SAME_16;
1035 put_unaligned_be64(lba, &cmd->cmnd[2]);
1036 put_unaligned_be32(nr_blocks, &cmd->cmnd[10]);
1037 } else {
1038 cmd->cmd_len = 10;
1039 cmd->cmnd[0] = WRITE_SAME;
1040 put_unaligned_be32(lba, &cmd->cmnd[2]);
1041 put_unaligned_be16(nr_blocks, &cmd->cmnd[7]);
1042 }
1043
1044 cmd->transfersize = sdp->sector_size;
1045 cmd->allowed = SD_MAX_RETRIES;
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057 rq->__data_len = sdp->sector_size;
1058 ret = scsi_init_io(cmd);
1059 rq->__data_len = blk_rq_bytes(rq);
1060
1061 return ret;
1062 }
1063
1064 static blk_status_t sd_setup_flush_cmnd(struct scsi_cmnd *cmd)
1065 {
1066 struct request *rq = cmd->request;
1067
1068
1069 memset(&cmd->sdb, 0, sizeof(cmd->sdb));
1070
1071 cmd->cmnd[0] = SYNCHRONIZE_CACHE;
1072 cmd->cmd_len = 10;
1073 cmd->transfersize = 0;
1074 cmd->allowed = SD_MAX_RETRIES;
1075
1076 rq->timeout = rq->q->rq_timeout * SD_FLUSH_TIMEOUT_MULTIPLIER;
1077 return BLK_STS_OK;
1078 }
1079
1080 static blk_status_t sd_setup_rw32_cmnd(struct scsi_cmnd *cmd, bool write,
1081 sector_t lba, unsigned int nr_blocks,
1082 unsigned char flags)
1083 {
1084 cmd->cmnd = mempool_alloc(sd_cdb_pool, GFP_ATOMIC);
1085 if (unlikely(cmd->cmnd == NULL))
1086 return BLK_STS_RESOURCE;
1087
1088 cmd->cmd_len = SD_EXT_CDB_SIZE;
1089 memset(cmd->cmnd, 0, cmd->cmd_len);
1090
1091 cmd->cmnd[0] = VARIABLE_LENGTH_CMD;
1092 cmd->cmnd[7] = 0x18;
1093 cmd->cmnd[9] = write ? WRITE_32 : READ_32;
1094 cmd->cmnd[10] = flags;
1095 put_unaligned_be64(lba, &cmd->cmnd[12]);
1096 put_unaligned_be32(lba, &cmd->cmnd[20]);
1097 put_unaligned_be32(nr_blocks, &cmd->cmnd[28]);
1098
1099 return BLK_STS_OK;
1100 }
1101
1102 static blk_status_t sd_setup_rw16_cmnd(struct scsi_cmnd *cmd, bool write,
1103 sector_t lba, unsigned int nr_blocks,
1104 unsigned char flags)
1105 {
1106 cmd->cmd_len = 16;
1107 cmd->cmnd[0] = write ? WRITE_16 : READ_16;
1108 cmd->cmnd[1] = flags;
1109 cmd->cmnd[14] = 0;
1110 cmd->cmnd[15] = 0;
1111 put_unaligned_be64(lba, &cmd->cmnd[2]);
1112 put_unaligned_be32(nr_blocks, &cmd->cmnd[10]);
1113
1114 return BLK_STS_OK;
1115 }
1116
1117 static blk_status_t sd_setup_rw10_cmnd(struct scsi_cmnd *cmd, bool write,
1118 sector_t lba, unsigned int nr_blocks,
1119 unsigned char flags)
1120 {
1121 cmd->cmd_len = 10;
1122 cmd->cmnd[0] = write ? WRITE_10 : READ_10;
1123 cmd->cmnd[1] = flags;
1124 cmd->cmnd[6] = 0;
1125 cmd->cmnd[9] = 0;
1126 put_unaligned_be32(lba, &cmd->cmnd[2]);
1127 put_unaligned_be16(nr_blocks, &cmd->cmnd[7]);
1128
1129 return BLK_STS_OK;
1130 }
1131
1132 static blk_status_t sd_setup_rw6_cmnd(struct scsi_cmnd *cmd, bool write,
1133 sector_t lba, unsigned int nr_blocks,
1134 unsigned char flags)
1135 {
1136
1137 if (WARN_ON_ONCE(nr_blocks == 0))
1138 return BLK_STS_IOERR;
1139
1140 if (unlikely(flags & 0x8)) {
1141
1142
1143
1144
1145
1146 scmd_printk(KERN_ERR, cmd, "FUA write on READ/WRITE(6) drive\n");
1147 return BLK_STS_IOERR;
1148 }
1149
1150 cmd->cmd_len = 6;
1151 cmd->cmnd[0] = write ? WRITE_6 : READ_6;
1152 cmd->cmnd[1] = (lba >> 16) & 0x1f;
1153 cmd->cmnd[2] = (lba >> 8) & 0xff;
1154 cmd->cmnd[3] = lba & 0xff;
1155 cmd->cmnd[4] = nr_blocks;
1156 cmd->cmnd[5] = 0;
1157
1158 return BLK_STS_OK;
1159 }
1160
1161 static blk_status_t sd_setup_read_write_cmnd(struct scsi_cmnd *cmd)
1162 {
1163 struct request *rq = cmd->request;
1164 struct scsi_device *sdp = cmd->device;
1165 struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
1166 sector_t lba = sectors_to_logical(sdp, blk_rq_pos(rq));
1167 sector_t threshold;
1168 unsigned int nr_blocks = sectors_to_logical(sdp, blk_rq_sectors(rq));
1169 unsigned int mask = logical_to_sectors(sdp, 1) - 1;
1170 bool write = rq_data_dir(rq) == WRITE;
1171 unsigned char protect, fua;
1172 blk_status_t ret;
1173 unsigned int dif;
1174 bool dix;
1175
1176 ret = scsi_init_io(cmd);
1177 if (ret != BLK_STS_OK)
1178 return ret;
1179
1180 if (!scsi_device_online(sdp) || sdp->changed) {
1181 scmd_printk(KERN_ERR, cmd, "device offline or changed\n");
1182 return BLK_STS_IOERR;
1183 }
1184
1185 if (blk_rq_pos(rq) + blk_rq_sectors(rq) > get_capacity(rq->rq_disk)) {
1186 scmd_printk(KERN_ERR, cmd, "access beyond end of device\n");
1187 return BLK_STS_IOERR;
1188 }
1189
1190 if ((blk_rq_pos(rq) & mask) || (blk_rq_sectors(rq) & mask)) {
1191 scmd_printk(KERN_ERR, cmd, "request not aligned to the logical block size\n");
1192 return BLK_STS_IOERR;
1193 }
1194
1195
1196
1197
1198
1199 threshold = sdkp->capacity - SD_LAST_BUGGY_SECTORS;
1200
1201 if (unlikely(sdp->last_sector_bug && lba + nr_blocks > threshold)) {
1202 if (lba < threshold) {
1203
1204 nr_blocks = threshold - lba;
1205 } else {
1206
1207 nr_blocks = 1;
1208 }
1209 }
1210
1211 fua = rq->cmd_flags & REQ_FUA ? 0x8 : 0;
1212 dix = scsi_prot_sg_count(cmd);
1213 dif = scsi_host_dif_capable(cmd->device->host, sdkp->protection_type);
1214
1215 if (dif || dix)
1216 protect = sd_setup_protect_cmnd(cmd, dix, dif);
1217 else
1218 protect = 0;
1219
1220 if (protect && sdkp->protection_type == T10_PI_TYPE2_PROTECTION) {
1221 ret = sd_setup_rw32_cmnd(cmd, write, lba, nr_blocks,
1222 protect | fua);
1223 } else if (sdp->use_16_for_rw || (nr_blocks > 0xffff)) {
1224 ret = sd_setup_rw16_cmnd(cmd, write, lba, nr_blocks,
1225 protect | fua);
1226 } else if ((nr_blocks > 0xff) || (lba > 0x1fffff) ||
1227 sdp->use_10_for_rw || protect) {
1228 ret = sd_setup_rw10_cmnd(cmd, write, lba, nr_blocks,
1229 protect | fua);
1230 } else {
1231 ret = sd_setup_rw6_cmnd(cmd, write, lba, nr_blocks,
1232 protect | fua);
1233 }
1234
1235 if (unlikely(ret != BLK_STS_OK))
1236 return ret;
1237
1238
1239
1240
1241
1242
1243 cmd->transfersize = sdp->sector_size;
1244 cmd->underflow = nr_blocks << 9;
1245 cmd->allowed = SD_MAX_RETRIES;
1246 cmd->sdb.length = nr_blocks * sdp->sector_size;
1247
1248 SCSI_LOG_HLQUEUE(1,
1249 scmd_printk(KERN_INFO, cmd,
1250 "%s: block=%llu, count=%d\n", __func__,
1251 (unsigned long long)blk_rq_pos(rq),
1252 blk_rq_sectors(rq)));
1253 SCSI_LOG_HLQUEUE(2,
1254 scmd_printk(KERN_INFO, cmd,
1255 "%s %d/%u 512 byte blocks.\n",
1256 write ? "writing" : "reading", nr_blocks,
1257 blk_rq_sectors(rq)));
1258
1259
1260
1261
1262
1263 return BLK_STS_OK;
1264 }
1265
1266 static blk_status_t sd_init_command(struct scsi_cmnd *cmd)
1267 {
1268 struct request *rq = cmd->request;
1269
1270 switch (req_op(rq)) {
1271 case REQ_OP_DISCARD:
1272 switch (scsi_disk(rq->rq_disk)->provisioning_mode) {
1273 case SD_LBP_UNMAP:
1274 return sd_setup_unmap_cmnd(cmd);
1275 case SD_LBP_WS16:
1276 return sd_setup_write_same16_cmnd(cmd, true);
1277 case SD_LBP_WS10:
1278 return sd_setup_write_same10_cmnd(cmd, true);
1279 case SD_LBP_ZERO:
1280 return sd_setup_write_same10_cmnd(cmd, false);
1281 default:
1282 return BLK_STS_TARGET;
1283 }
1284 case REQ_OP_WRITE_ZEROES:
1285 return sd_setup_write_zeroes_cmnd(cmd);
1286 case REQ_OP_WRITE_SAME:
1287 return sd_setup_write_same_cmnd(cmd);
1288 case REQ_OP_FLUSH:
1289 return sd_setup_flush_cmnd(cmd);
1290 case REQ_OP_READ:
1291 case REQ_OP_WRITE:
1292 return sd_setup_read_write_cmnd(cmd);
1293 case REQ_OP_ZONE_RESET:
1294 return sd_zbc_setup_reset_cmnd(cmd, false);
1295 case REQ_OP_ZONE_RESET_ALL:
1296 return sd_zbc_setup_reset_cmnd(cmd, true);
1297 default:
1298 WARN_ON_ONCE(1);
1299 return BLK_STS_NOTSUPP;
1300 }
1301 }
1302
1303 static void sd_uninit_command(struct scsi_cmnd *SCpnt)
1304 {
1305 struct request *rq = SCpnt->request;
1306 u8 *cmnd;
1307
1308 if (rq->rq_flags & RQF_SPECIAL_PAYLOAD)
1309 mempool_free(rq->special_vec.bv_page, sd_page_pool);
1310
1311 if (SCpnt->cmnd != scsi_req(rq)->cmd) {
1312 cmnd = SCpnt->cmnd;
1313 SCpnt->cmnd = NULL;
1314 SCpnt->cmd_len = 0;
1315 mempool_free(cmnd, sd_cdb_pool);
1316 }
1317 }
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334 static int sd_open(struct block_device *bdev, fmode_t mode)
1335 {
1336 struct scsi_disk *sdkp = scsi_disk_get(bdev->bd_disk);
1337 struct scsi_device *sdev;
1338 int retval;
1339
1340 if (!sdkp)
1341 return -ENXIO;
1342
1343 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_open\n"));
1344
1345 sdev = sdkp->device;
1346
1347
1348
1349
1350
1351 retval = -ENXIO;
1352 if (!scsi_block_when_processing_errors(sdev))
1353 goto error_out;
1354
1355 if (sdev->removable || sdkp->write_prot)
1356 check_disk_change(bdev);
1357
1358
1359
1360
1361 retval = -ENOMEDIUM;
1362 if (sdev->removable && !sdkp->media_present && !(mode & FMODE_NDELAY))
1363 goto error_out;
1364
1365
1366
1367
1368
1369 retval = -EROFS;
1370 if (sdkp->write_prot && (mode & FMODE_WRITE))
1371 goto error_out;
1372
1373
1374
1375
1376
1377
1378
1379 retval = -ENXIO;
1380 if (!scsi_device_online(sdev))
1381 goto error_out;
1382
1383 if ((atomic_inc_return(&sdkp->openers) == 1) && sdev->removable) {
1384 if (scsi_block_when_processing_errors(sdev))
1385 scsi_set_medium_removal(sdev, SCSI_REMOVAL_PREVENT);
1386 }
1387
1388 return 0;
1389
1390 error_out:
1391 scsi_disk_put(sdkp);
1392 return retval;
1393 }
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
1404
1405
1406
1407
1408 static void sd_release(struct gendisk *disk, fmode_t mode)
1409 {
1410 struct scsi_disk *sdkp = scsi_disk(disk);
1411 struct scsi_device *sdev = sdkp->device;
1412
1413 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_release\n"));
1414
1415 if (atomic_dec_return(&sdkp->openers) == 0 && sdev->removable) {
1416 if (scsi_block_when_processing_errors(sdev))
1417 scsi_set_medium_removal(sdev, SCSI_REMOVAL_ALLOW);
1418 }
1419
1420 scsi_disk_put(sdkp);
1421 }
1422
1423 static int sd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1424 {
1425 struct scsi_disk *sdkp = scsi_disk(bdev->bd_disk);
1426 struct scsi_device *sdp = sdkp->device;
1427 struct Scsi_Host *host = sdp->host;
1428 sector_t capacity = logical_to_sectors(sdp, sdkp->capacity);
1429 int diskinfo[4];
1430
1431
1432 diskinfo[0] = 0x40;
1433 diskinfo[1] = 0x20;
1434 diskinfo[2] = capacity >> 11;
1435
1436
1437 if (host->hostt->bios_param)
1438 host->hostt->bios_param(sdp, bdev, capacity, diskinfo);
1439 else
1440 scsicam_bios_param(bdev, capacity, diskinfo);
1441
1442 geo->heads = diskinfo[0];
1443 geo->sectors = diskinfo[1];
1444 geo->cylinders = diskinfo[2];
1445 return 0;
1446 }
1447
1448
1449
1450
1451
1452
1453
1454
1455
1456
1457
1458
1459
1460
1461
1462 static int sd_ioctl(struct block_device *bdev, fmode_t mode,
1463 unsigned int cmd, unsigned long arg)
1464 {
1465 struct gendisk *disk = bdev->bd_disk;
1466 struct scsi_disk *sdkp = scsi_disk(disk);
1467 struct scsi_device *sdp = sdkp->device;
1468 void __user *p = (void __user *)arg;
1469 int error;
1470
1471 SCSI_LOG_IOCTL(1, sd_printk(KERN_INFO, sdkp, "sd_ioctl: disk=%s, "
1472 "cmd=0x%x\n", disk->disk_name, cmd));
1473
1474 error = scsi_verify_blk_ioctl(bdev, cmd);
1475 if (error < 0)
1476 return error;
1477
1478
1479
1480
1481
1482
1483
1484 error = scsi_ioctl_block_when_processing_errors(sdp, cmd,
1485 (mode & FMODE_NDELAY) != 0);
1486 if (error)
1487 goto out;
1488
1489 if (is_sed_ioctl(cmd))
1490 return sed_ioctl(sdkp->opal_dev, cmd, p);
1491
1492
1493
1494
1495
1496
1497 switch (cmd) {
1498 case SCSI_IOCTL_GET_IDLUN:
1499 case SCSI_IOCTL_GET_BUS_NUMBER:
1500 error = scsi_ioctl(sdp, cmd, p);
1501 break;
1502 default:
1503 error = scsi_cmd_blk_ioctl(bdev, mode, cmd, p);
1504 if (error != -ENOTTY)
1505 break;
1506 error = scsi_ioctl(sdp, cmd, p);
1507 break;
1508 }
1509 out:
1510 return error;
1511 }
1512
1513 static void set_media_not_present(struct scsi_disk *sdkp)
1514 {
1515 if (sdkp->media_present)
1516 sdkp->device->changed = 1;
1517
1518 if (sdkp->device->removable) {
1519 sdkp->media_present = 0;
1520 sdkp->capacity = 0;
1521 }
1522 }
1523
1524 static int media_not_present(struct scsi_disk *sdkp,
1525 struct scsi_sense_hdr *sshdr)
1526 {
1527 if (!scsi_sense_valid(sshdr))
1528 return 0;
1529
1530
1531 switch (sshdr->sense_key) {
1532 case UNIT_ATTENTION:
1533 case NOT_READY:
1534
1535 if (sshdr->asc == 0x3A) {
1536 set_media_not_present(sdkp);
1537 return 1;
1538 }
1539 }
1540 return 0;
1541 }
1542
1543
1544
1545
1546
1547
1548
1549
1550
1551
1552 static unsigned int sd_check_events(struct gendisk *disk, unsigned int clearing)
1553 {
1554 struct scsi_disk *sdkp = scsi_disk_get(disk);
1555 struct scsi_device *sdp;
1556 int retval;
1557
1558 if (!sdkp)
1559 return 0;
1560
1561 sdp = sdkp->device;
1562 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_check_events\n"));
1563
1564
1565
1566
1567
1568
1569
1570 if (!scsi_device_online(sdp)) {
1571 set_media_not_present(sdkp);
1572 goto out;
1573 }
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584 if (scsi_block_when_processing_errors(sdp)) {
1585 struct scsi_sense_hdr sshdr = { 0, };
1586
1587 retval = scsi_test_unit_ready(sdp, SD_TIMEOUT, SD_MAX_RETRIES,
1588 &sshdr);
1589
1590
1591 if (host_byte(retval)) {
1592 set_media_not_present(sdkp);
1593 goto out;
1594 }
1595
1596 if (media_not_present(sdkp, &sshdr))
1597 goto out;
1598 }
1599
1600
1601
1602
1603
1604 if (!sdkp->media_present)
1605 sdp->changed = 1;
1606 sdkp->media_present = 1;
1607 out:
1608
1609
1610
1611
1612
1613
1614 retval = sdp->changed ? DISK_EVENT_MEDIA_CHANGE : 0;
1615 sdp->changed = 0;
1616 scsi_disk_put(sdkp);
1617 return retval;
1618 }
1619
1620 static int sd_sync_cache(struct scsi_disk *sdkp, struct scsi_sense_hdr *sshdr)
1621 {
1622 int retries, res;
1623 struct scsi_device *sdp = sdkp->device;
1624 const int timeout = sdp->request_queue->rq_timeout
1625 * SD_FLUSH_TIMEOUT_MULTIPLIER;
1626 struct scsi_sense_hdr my_sshdr;
1627
1628 if (!scsi_device_online(sdp))
1629 return -ENODEV;
1630
1631
1632 if (!sshdr)
1633 sshdr = &my_sshdr;
1634
1635 for (retries = 3; retries > 0; --retries) {
1636 unsigned char cmd[10] = { 0 };
1637
1638 cmd[0] = SYNCHRONIZE_CACHE;
1639
1640
1641
1642
1643 res = scsi_execute(sdp, cmd, DMA_NONE, NULL, 0, NULL, sshdr,
1644 timeout, SD_MAX_RETRIES, 0, RQF_PM, NULL);
1645 if (res == 0)
1646 break;
1647 }
1648
1649 if (res) {
1650 sd_print_result(sdkp, "Synchronize Cache(10) failed", res);
1651
1652 if (driver_byte(res) == DRIVER_SENSE)
1653 sd_print_sense_hdr(sdkp, sshdr);
1654
1655
1656 if (scsi_sense_valid(sshdr) &&
1657 (sshdr->asc == 0x3a ||
1658 sshdr->asc == 0x20 ||
1659 (sshdr->asc == 0x74 && sshdr->ascq == 0x71)))
1660
1661 return 0;
1662
1663 switch (host_byte(res)) {
1664
1665 case DID_BAD_TARGET:
1666 case DID_NO_CONNECT:
1667 return 0;
1668
1669 case DID_BUS_BUSY:
1670 case DID_IMM_RETRY:
1671 case DID_REQUEUE:
1672 case DID_SOFT_ERROR:
1673 return -EBUSY;
1674 default:
1675 return -EIO;
1676 }
1677 }
1678 return 0;
1679 }
1680
1681 static void sd_rescan(struct device *dev)
1682 {
1683 struct scsi_disk *sdkp = dev_get_drvdata(dev);
1684
1685 revalidate_disk(sdkp->disk);
1686 }
1687
1688
1689 #ifdef CONFIG_COMPAT
1690
1691
1692
1693
1694 static int sd_compat_ioctl(struct block_device *bdev, fmode_t mode,
1695 unsigned int cmd, unsigned long arg)
1696 {
1697 struct gendisk *disk = bdev->bd_disk;
1698 struct scsi_disk *sdkp = scsi_disk(disk);
1699 struct scsi_device *sdev = sdkp->device;
1700 void __user *p = compat_ptr(arg);
1701 int error;
1702
1703 error = scsi_verify_blk_ioctl(bdev, cmd);
1704 if (error < 0)
1705 return error;
1706
1707 error = scsi_ioctl_block_when_processing_errors(sdev, cmd,
1708 (mode & FMODE_NDELAY) != 0);
1709 if (error)
1710 return error;
1711
1712 if (is_sed_ioctl(cmd))
1713 return sed_ioctl(sdkp->opal_dev, cmd, p);
1714
1715
1716
1717
1718 if (!sdev->host->hostt->compat_ioctl)
1719 return -ENOIOCTLCMD;
1720 return sdev->host->hostt->compat_ioctl(sdev, cmd, p);
1721 }
1722 #endif
1723
1724 static char sd_pr_type(enum pr_type type)
1725 {
1726 switch (type) {
1727 case PR_WRITE_EXCLUSIVE:
1728 return 0x01;
1729 case PR_EXCLUSIVE_ACCESS:
1730 return 0x03;
1731 case PR_WRITE_EXCLUSIVE_REG_ONLY:
1732 return 0x05;
1733 case PR_EXCLUSIVE_ACCESS_REG_ONLY:
1734 return 0x06;
1735 case PR_WRITE_EXCLUSIVE_ALL_REGS:
1736 return 0x07;
1737 case PR_EXCLUSIVE_ACCESS_ALL_REGS:
1738 return 0x08;
1739 default:
1740 return 0;
1741 }
1742 };
1743
1744 static int sd_pr_command(struct block_device *bdev, u8 sa,
1745 u64 key, u64 sa_key, u8 type, u8 flags)
1746 {
1747 struct scsi_device *sdev = scsi_disk(bdev->bd_disk)->device;
1748 struct scsi_sense_hdr sshdr;
1749 int result;
1750 u8 cmd[16] = { 0, };
1751 u8 data[24] = { 0, };
1752
1753 cmd[0] = PERSISTENT_RESERVE_OUT;
1754 cmd[1] = sa;
1755 cmd[2] = type;
1756 put_unaligned_be32(sizeof(data), &cmd[5]);
1757
1758 put_unaligned_be64(key, &data[0]);
1759 put_unaligned_be64(sa_key, &data[8]);
1760 data[20] = flags;
1761
1762 result = scsi_execute_req(sdev, cmd, DMA_TO_DEVICE, &data, sizeof(data),
1763 &sshdr, SD_TIMEOUT, SD_MAX_RETRIES, NULL);
1764
1765 if (driver_byte(result) == DRIVER_SENSE &&
1766 scsi_sense_valid(&sshdr)) {
1767 sdev_printk(KERN_INFO, sdev, "PR command failed: %d\n", result);
1768 scsi_print_sense_hdr(sdev, NULL, &sshdr);
1769 }
1770
1771 return result;
1772 }
1773
1774 static int sd_pr_register(struct block_device *bdev, u64 old_key, u64 new_key,
1775 u32 flags)
1776 {
1777 if (flags & ~PR_FL_IGNORE_KEY)
1778 return -EOPNOTSUPP;
1779 return sd_pr_command(bdev, (flags & PR_FL_IGNORE_KEY) ? 0x06 : 0x00,
1780 old_key, new_key, 0,
1781 (1 << 0) );
1782 }
1783
1784 static int sd_pr_reserve(struct block_device *bdev, u64 key, enum pr_type type,
1785 u32 flags)
1786 {
1787 if (flags)
1788 return -EOPNOTSUPP;
1789 return sd_pr_command(bdev, 0x01, key, 0, sd_pr_type(type), 0);
1790 }
1791
1792 static int sd_pr_release(struct block_device *bdev, u64 key, enum pr_type type)
1793 {
1794 return sd_pr_command(bdev, 0x02, key, 0, sd_pr_type(type), 0);
1795 }
1796
1797 static int sd_pr_preempt(struct block_device *bdev, u64 old_key, u64 new_key,
1798 enum pr_type type, bool abort)
1799 {
1800 return sd_pr_command(bdev, abort ? 0x05 : 0x04, old_key, new_key,
1801 sd_pr_type(type), 0);
1802 }
1803
1804 static int sd_pr_clear(struct block_device *bdev, u64 key)
1805 {
1806 return sd_pr_command(bdev, 0x03, key, 0, 0, 0);
1807 }
1808
1809 static const struct pr_ops sd_pr_ops = {
1810 .pr_register = sd_pr_register,
1811 .pr_reserve = sd_pr_reserve,
1812 .pr_release = sd_pr_release,
1813 .pr_preempt = sd_pr_preempt,
1814 .pr_clear = sd_pr_clear,
1815 };
1816
1817 static const struct block_device_operations sd_fops = {
1818 .owner = THIS_MODULE,
1819 .open = sd_open,
1820 .release = sd_release,
1821 .ioctl = sd_ioctl,
1822 .getgeo = sd_getgeo,
1823 #ifdef CONFIG_COMPAT
1824 .compat_ioctl = sd_compat_ioctl,
1825 #endif
1826 .check_events = sd_check_events,
1827 .revalidate_disk = sd_revalidate_disk,
1828 .unlock_native_capacity = sd_unlock_native_capacity,
1829 .report_zones = sd_zbc_report_zones,
1830 .pr_ops = &sd_pr_ops,
1831 };
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843
1844
1845 static void sd_eh_reset(struct scsi_cmnd *scmd)
1846 {
1847 struct scsi_disk *sdkp = scsi_disk(scmd->request->rq_disk);
1848
1849
1850 sdkp->ignore_medium_access_errors = false;
1851 }
1852
1853
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865 static int sd_eh_action(struct scsi_cmnd *scmd, int eh_disp)
1866 {
1867 struct scsi_disk *sdkp = scsi_disk(scmd->request->rq_disk);
1868 struct scsi_device *sdev = scmd->device;
1869
1870 if (!scsi_device_online(sdev) ||
1871 !scsi_medium_access_command(scmd) ||
1872 host_byte(scmd->result) != DID_TIME_OUT ||
1873 eh_disp != SUCCESS)
1874 return eh_disp;
1875
1876
1877
1878
1879
1880
1881
1882
1883 if (!sdkp->ignore_medium_access_errors) {
1884 sdkp->medium_access_timed_out++;
1885 sdkp->ignore_medium_access_errors = true;
1886 }
1887
1888
1889
1890
1891
1892
1893 if (sdkp->medium_access_timed_out >= sdkp->max_medium_access_timeouts) {
1894 scmd_printk(KERN_ERR, scmd,
1895 "Medium access timeout failure. Offlining disk!\n");
1896 mutex_lock(&sdev->state_mutex);
1897 scsi_device_set_state(sdev, SDEV_OFFLINE);
1898 mutex_unlock(&sdev->state_mutex);
1899
1900 return SUCCESS;
1901 }
1902
1903 return eh_disp;
1904 }
1905
1906 static unsigned int sd_completed_bytes(struct scsi_cmnd *scmd)
1907 {
1908 struct request *req = scmd->request;
1909 struct scsi_device *sdev = scmd->device;
1910 unsigned int transferred, good_bytes;
1911 u64 start_lba, end_lba, bad_lba;
1912
1913
1914
1915
1916
1917 if (scsi_bufflen(scmd) <= sdev->sector_size)
1918 return 0;
1919
1920
1921 if (!scsi_get_sense_info_fld(scmd->sense_buffer,
1922 SCSI_SENSE_BUFFERSIZE,
1923 &bad_lba))
1924 return 0;
1925
1926
1927
1928
1929
1930 start_lba = sectors_to_logical(sdev, blk_rq_pos(req));
1931 end_lba = start_lba + bytes_to_logical(sdev, scsi_bufflen(scmd));
1932 if (bad_lba < start_lba || bad_lba >= end_lba)
1933 return 0;
1934
1935
1936
1937
1938
1939 transferred = scsi_bufflen(scmd) - scsi_get_resid(scmd);
1940
1941
1942
1943
1944 good_bytes = logical_to_bytes(sdev, bad_lba - start_lba);
1945
1946 return min(good_bytes, transferred);
1947 }
1948
1949
1950
1951
1952
1953
1954
1955
1956 static int sd_done(struct scsi_cmnd *SCpnt)
1957 {
1958 int result = SCpnt->result;
1959 unsigned int good_bytes = result ? 0 : scsi_bufflen(SCpnt);
1960 unsigned int sector_size = SCpnt->device->sector_size;
1961 unsigned int resid;
1962 struct scsi_sense_hdr sshdr;
1963 struct scsi_disk *sdkp = scsi_disk(SCpnt->request->rq_disk);
1964 struct request *req = SCpnt->request;
1965 int sense_valid = 0;
1966 int sense_deferred = 0;
1967
1968 switch (req_op(req)) {
1969 case REQ_OP_DISCARD:
1970 case REQ_OP_WRITE_ZEROES:
1971 case REQ_OP_WRITE_SAME:
1972 case REQ_OP_ZONE_RESET:
1973 case REQ_OP_ZONE_RESET_ALL:
1974 if (!result) {
1975 good_bytes = blk_rq_bytes(req);
1976 scsi_set_resid(SCpnt, 0);
1977 } else {
1978 good_bytes = 0;
1979 scsi_set_resid(SCpnt, blk_rq_bytes(req));
1980 }
1981 break;
1982 default:
1983
1984
1985
1986
1987
1988 resid = scsi_get_resid(SCpnt);
1989 if (resid & (sector_size - 1)) {
1990 sd_printk(KERN_INFO, sdkp,
1991 "Unaligned partial completion (resid=%u, sector_sz=%u)\n",
1992 resid, sector_size);
1993 scsi_print_command(SCpnt);
1994 resid = min(scsi_bufflen(SCpnt),
1995 round_up(resid, sector_size));
1996 scsi_set_resid(SCpnt, resid);
1997 }
1998 }
1999
2000 if (result) {
2001 sense_valid = scsi_command_normalize_sense(SCpnt, &sshdr);
2002 if (sense_valid)
2003 sense_deferred = scsi_sense_is_deferred(&sshdr);
2004 }
2005 sdkp->medium_access_timed_out = 0;
2006
2007 if (driver_byte(result) != DRIVER_SENSE &&
2008 (!sense_valid || sense_deferred))
2009 goto out;
2010
2011 switch (sshdr.sense_key) {
2012 case HARDWARE_ERROR:
2013 case MEDIUM_ERROR:
2014 good_bytes = sd_completed_bytes(SCpnt);
2015 break;
2016 case RECOVERED_ERROR:
2017 good_bytes = scsi_bufflen(SCpnt);
2018 break;
2019 case NO_SENSE:
2020
2021
2022
2023
2024 SCpnt->result = 0;
2025 memset(SCpnt->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
2026 break;
2027 case ABORTED_COMMAND:
2028 if (sshdr.asc == 0x10)
2029 good_bytes = sd_completed_bytes(SCpnt);
2030 break;
2031 case ILLEGAL_REQUEST:
2032 switch (sshdr.asc) {
2033 case 0x10:
2034 good_bytes = sd_completed_bytes(SCpnt);
2035 break;
2036 case 0x20:
2037 case 0x24:
2038 switch (SCpnt->cmnd[0]) {
2039 case UNMAP:
2040 sd_config_discard(sdkp, SD_LBP_DISABLE);
2041 break;
2042 case WRITE_SAME_16:
2043 case WRITE_SAME:
2044 if (SCpnt->cmnd[1] & 8) {
2045 sd_config_discard(sdkp, SD_LBP_DISABLE);
2046 } else {
2047 sdkp->device->no_write_same = 1;
2048 sd_config_write_same(sdkp);
2049 req->rq_flags |= RQF_QUIET;
2050 }
2051 break;
2052 }
2053 }
2054 break;
2055 default:
2056 break;
2057 }
2058
2059 out:
2060 if (sd_is_zoned(sdkp))
2061 sd_zbc_complete(SCpnt, good_bytes, &sshdr);
2062
2063 SCSI_LOG_HLCOMPLETE(1, scmd_printk(KERN_INFO, SCpnt,
2064 "sd_done: completed %d of %d bytes\n",
2065 good_bytes, scsi_bufflen(SCpnt)));
2066
2067 return good_bytes;
2068 }
2069
2070
2071
2072
2073 static void
2074 sd_spinup_disk(struct scsi_disk *sdkp)
2075 {
2076 unsigned char cmd[10];
2077 unsigned long spintime_expire = 0;
2078 int retries, spintime;
2079 unsigned int the_result;
2080 struct scsi_sense_hdr sshdr;
2081 int sense_valid = 0;
2082
2083 spintime = 0;
2084
2085
2086
2087 do {
2088 retries = 0;
2089
2090 do {
2091 cmd[0] = TEST_UNIT_READY;
2092 memset((void *) &cmd[1], 0, 9);
2093
2094 the_result = scsi_execute_req(sdkp->device, cmd,
2095 DMA_NONE, NULL, 0,
2096 &sshdr, SD_TIMEOUT,
2097 SD_MAX_RETRIES, NULL);
2098
2099
2100
2101
2102
2103
2104 if (media_not_present(sdkp, &sshdr))
2105 return;
2106
2107 if (the_result)
2108 sense_valid = scsi_sense_valid(&sshdr);
2109 retries++;
2110 } while (retries < 3 &&
2111 (!scsi_status_is_good(the_result) ||
2112 ((driver_byte(the_result) == DRIVER_SENSE) &&
2113 sense_valid && sshdr.sense_key == UNIT_ATTENTION)));
2114
2115 if (driver_byte(the_result) != DRIVER_SENSE) {
2116
2117
2118 if(!spintime && !scsi_status_is_good(the_result)) {
2119 sd_print_result(sdkp, "Test Unit Ready failed",
2120 the_result);
2121 }
2122 break;
2123 }
2124
2125
2126
2127
2128 if (sdkp->device->no_start_on_add)
2129 break;
2130
2131 if (sense_valid && sshdr.sense_key == NOT_READY) {
2132 if (sshdr.asc == 4 && sshdr.ascq == 3)
2133 break;
2134 if (sshdr.asc == 4 && sshdr.ascq == 0xb)
2135 break;
2136 if (sshdr.asc == 4 && sshdr.ascq == 0xc)
2137 break;
2138 if (sshdr.asc == 4 && sshdr.ascq == 0x1b)
2139 break;
2140
2141
2142
2143 if (!spintime) {
2144 sd_printk(KERN_NOTICE, sdkp, "Spinning up disk...");
2145 cmd[0] = START_STOP;
2146 cmd[1] = 1;
2147 memset((void *) &cmd[2], 0, 8);
2148 cmd[4] = 1;
2149 if (sdkp->device->start_stop_pwr_cond)
2150 cmd[4] |= 1 << 4;
2151 scsi_execute_req(sdkp->device, cmd, DMA_NONE,
2152 NULL, 0, &sshdr,
2153 SD_TIMEOUT, SD_MAX_RETRIES,
2154 NULL);
2155 spintime_expire = jiffies + 100 * HZ;
2156 spintime = 1;
2157 }
2158
2159 msleep(1000);
2160 printk(KERN_CONT ".");
2161
2162
2163
2164
2165
2166
2167 } else if (sense_valid &&
2168 sshdr.sense_key == UNIT_ATTENTION &&
2169 sshdr.asc == 0x28) {
2170 if (!spintime) {
2171 spintime_expire = jiffies + 5 * HZ;
2172 spintime = 1;
2173 }
2174
2175 msleep(1000);
2176 } else {
2177
2178
2179 if(!spintime) {
2180 sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready\n");
2181 sd_print_sense_hdr(sdkp, &sshdr);
2182 }
2183 break;
2184 }
2185
2186 } while (spintime && time_before_eq(jiffies, spintime_expire));
2187
2188 if (spintime) {
2189 if (scsi_status_is_good(the_result))
2190 printk(KERN_CONT "ready\n");
2191 else
2192 printk(KERN_CONT "not responding...\n");
2193 }
2194 }
2195
2196
2197
2198
2199 static int sd_read_protection_type(struct scsi_disk *sdkp, unsigned char *buffer)
2200 {
2201 struct scsi_device *sdp = sdkp->device;
2202 u8 type;
2203 int ret = 0;
2204
2205 if (scsi_device_protection(sdp) == 0 || (buffer[12] & 1) == 0) {
2206 sdkp->protection_type = 0;
2207 return ret;
2208 }
2209
2210 type = ((buffer[12] >> 1) & 7) + 1;
2211
2212 if (type > T10_PI_TYPE3_PROTECTION)
2213 ret = -ENODEV;
2214 else if (scsi_host_dif_capable(sdp->host, type))
2215 ret = 1;
2216
2217 if (sdkp->first_scan || type != sdkp->protection_type)
2218 switch (ret) {
2219 case -ENODEV:
2220 sd_printk(KERN_ERR, sdkp, "formatted with unsupported" \
2221 " protection type %u. Disabling disk!\n",
2222 type);
2223 break;
2224 case 1:
2225 sd_printk(KERN_NOTICE, sdkp,
2226 "Enabling DIF Type %u protection\n", type);
2227 break;
2228 case 0:
2229 sd_printk(KERN_NOTICE, sdkp,
2230 "Disabling DIF Type %u protection\n", type);
2231 break;
2232 }
2233
2234 sdkp->protection_type = type;
2235
2236 return ret;
2237 }
2238
2239 static void read_capacity_error(struct scsi_disk *sdkp, struct scsi_device *sdp,
2240 struct scsi_sense_hdr *sshdr, int sense_valid,
2241 int the_result)
2242 {
2243 if (driver_byte(the_result) == DRIVER_SENSE)
2244 sd_print_sense_hdr(sdkp, sshdr);
2245 else
2246 sd_printk(KERN_NOTICE, sdkp, "Sense not available.\n");
2247
2248
2249
2250
2251
2252 if (sdp->removable &&
2253 sense_valid && sshdr->sense_key == NOT_READY)
2254 set_media_not_present(sdkp);
2255
2256
2257
2258
2259
2260
2261 sdkp->capacity = 0;
2262 }
2263
2264 #define RC16_LEN 32
2265 #if RC16_LEN > SD_BUF_SIZE
2266 #error RC16_LEN must not be more than SD_BUF_SIZE
2267 #endif
2268
2269 #define READ_CAPACITY_RETRIES_ON_RESET 10
2270
2271 static int read_capacity_16(struct scsi_disk *sdkp, struct scsi_device *sdp,
2272 unsigned char *buffer)
2273 {
2274 unsigned char cmd[16];
2275 struct scsi_sense_hdr sshdr;
2276 int sense_valid = 0;
2277 int the_result;
2278 int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
2279 unsigned int alignment;
2280 unsigned long long lba;
2281 unsigned sector_size;
2282
2283 if (sdp->no_read_capacity_16)
2284 return -EINVAL;
2285
2286 do {
2287 memset(cmd, 0, 16);
2288 cmd[0] = SERVICE_ACTION_IN_16;
2289 cmd[1] = SAI_READ_CAPACITY_16;
2290 cmd[13] = RC16_LEN;
2291 memset(buffer, 0, RC16_LEN);
2292
2293 the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
2294 buffer, RC16_LEN, &sshdr,
2295 SD_TIMEOUT, SD_MAX_RETRIES, NULL);
2296
2297 if (media_not_present(sdkp, &sshdr))
2298 return -ENODEV;
2299
2300 if (the_result) {
2301 sense_valid = scsi_sense_valid(&sshdr);
2302 if (sense_valid &&
2303 sshdr.sense_key == ILLEGAL_REQUEST &&
2304 (sshdr.asc == 0x20 || sshdr.asc == 0x24) &&
2305 sshdr.ascq == 0x00)
2306
2307
2308
2309 return -EINVAL;
2310 if (sense_valid &&
2311 sshdr.sense_key == UNIT_ATTENTION &&
2312 sshdr.asc == 0x29 && sshdr.ascq == 0x00)
2313
2314
2315 if (--reset_retries > 0)
2316 continue;
2317 }
2318 retries--;
2319
2320 } while (the_result && retries);
2321
2322 if (the_result) {
2323 sd_print_result(sdkp, "Read Capacity(16) failed", the_result);
2324 read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
2325 return -EINVAL;
2326 }
2327
2328 sector_size = get_unaligned_be32(&buffer[8]);
2329 lba = get_unaligned_be64(&buffer[0]);
2330
2331 if (sd_read_protection_type(sdkp, buffer) < 0) {
2332 sdkp->capacity = 0;
2333 return -ENODEV;
2334 }
2335
2336
2337 sdkp->physical_block_size = (1 << (buffer[13] & 0xf)) * sector_size;
2338
2339
2340 sdkp->rc_basis = (buffer[12] >> 4) & 0x3;
2341
2342
2343 alignment = ((buffer[14] & 0x3f) << 8 | buffer[15]) * sector_size;
2344 blk_queue_alignment_offset(sdp->request_queue, alignment);
2345 if (alignment && sdkp->first_scan)
2346 sd_printk(KERN_NOTICE, sdkp,
2347 "physical block alignment offset: %u\n", alignment);
2348
2349 if (buffer[14] & 0x80) {
2350 sdkp->lbpme = 1;
2351
2352 if (buffer[14] & 0x40)
2353 sdkp->lbprz = 1;
2354
2355 sd_config_discard(sdkp, SD_LBP_WS16);
2356 }
2357
2358 sdkp->capacity = lba + 1;
2359 return sector_size;
2360 }
2361
2362 static int read_capacity_10(struct scsi_disk *sdkp, struct scsi_device *sdp,
2363 unsigned char *buffer)
2364 {
2365 unsigned char cmd[16];
2366 struct scsi_sense_hdr sshdr;
2367 int sense_valid = 0;
2368 int the_result;
2369 int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
2370 sector_t lba;
2371 unsigned sector_size;
2372
2373 do {
2374 cmd[0] = READ_CAPACITY;
2375 memset(&cmd[1], 0, 9);
2376 memset(buffer, 0, 8);
2377
2378 the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
2379 buffer, 8, &sshdr,
2380 SD_TIMEOUT, SD_MAX_RETRIES, NULL);
2381
2382 if (media_not_present(sdkp, &sshdr))
2383 return -ENODEV;
2384
2385 if (the_result) {
2386 sense_valid = scsi_sense_valid(&sshdr);
2387 if (sense_valid &&
2388 sshdr.sense_key == UNIT_ATTENTION &&
2389 sshdr.asc == 0x29 && sshdr.ascq == 0x00)
2390
2391
2392 if (--reset_retries > 0)
2393 continue;
2394 }
2395 retries--;
2396
2397 } while (the_result && retries);
2398
2399 if (the_result) {
2400 sd_print_result(sdkp, "Read Capacity(10) failed", the_result);
2401 read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
2402 return -EINVAL;
2403 }
2404
2405 sector_size = get_unaligned_be32(&buffer[4]);
2406 lba = get_unaligned_be32(&buffer[0]);
2407
2408 if (sdp->no_read_capacity_16 && (lba == 0xffffffff)) {
2409
2410
2411
2412 sdkp->capacity = 0;
2413 sdkp->physical_block_size = sector_size;
2414 return sector_size;
2415 }
2416
2417 sdkp->capacity = lba + 1;
2418 sdkp->physical_block_size = sector_size;
2419 return sector_size;
2420 }
2421
2422 static int sd_try_rc16_first(struct scsi_device *sdp)
2423 {
2424 if (sdp->host->max_cmd_len < 16)
2425 return 0;
2426 if (sdp->try_rc_10_first)
2427 return 0;
2428 if (sdp->scsi_level > SCSI_SPC_2)
2429 return 1;
2430 if (scsi_device_protection(sdp))
2431 return 1;
2432 return 0;
2433 }
2434
2435
2436
2437
2438 static void
2439 sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer)
2440 {
2441 int sector_size;
2442 struct scsi_device *sdp = sdkp->device;
2443
2444 if (sd_try_rc16_first(sdp)) {
2445 sector_size = read_capacity_16(sdkp, sdp, buffer);
2446 if (sector_size == -EOVERFLOW)
2447 goto got_data;
2448 if (sector_size == -ENODEV)
2449 return;
2450 if (sector_size < 0)
2451 sector_size = read_capacity_10(sdkp, sdp, buffer);
2452 if (sector_size < 0)
2453 return;
2454 } else {
2455 sector_size = read_capacity_10(sdkp, sdp, buffer);
2456 if (sector_size == -EOVERFLOW)
2457 goto got_data;
2458 if (sector_size < 0)
2459 return;
2460 if ((sizeof(sdkp->capacity) > 4) &&
2461 (sdkp->capacity > 0xffffffffULL)) {
2462 int old_sector_size = sector_size;
2463 sd_printk(KERN_NOTICE, sdkp, "Very big device. "
2464 "Trying to use READ CAPACITY(16).\n");
2465 sector_size = read_capacity_16(sdkp, sdp, buffer);
2466 if (sector_size < 0) {
2467 sd_printk(KERN_NOTICE, sdkp,
2468 "Using 0xffffffff as device size\n");
2469 sdkp->capacity = 1 + (sector_t) 0xffffffff;
2470 sector_size = old_sector_size;
2471 goto got_data;
2472 }
2473
2474 sdp->try_rc_10_first = 0;
2475 }
2476 }
2477
2478
2479
2480
2481
2482
2483
2484
2485
2486
2487
2488 if (sdp->fix_capacity ||
2489 (sdp->guess_capacity && (sdkp->capacity & 0x01))) {
2490 sd_printk(KERN_INFO, sdkp, "Adjusting the sector count "
2491 "from its reported value: %llu\n",
2492 (unsigned long long) sdkp->capacity);
2493 --sdkp->capacity;
2494 }
2495
2496 got_data:
2497 if (sector_size == 0) {
2498 sector_size = 512;
2499 sd_printk(KERN_NOTICE, sdkp, "Sector size 0 reported, "
2500 "assuming 512.\n");
2501 }
2502
2503 if (sector_size != 512 &&
2504 sector_size != 1024 &&
2505 sector_size != 2048 &&
2506 sector_size != 4096) {
2507 sd_printk(KERN_NOTICE, sdkp, "Unsupported sector size %d.\n",
2508 sector_size);
2509
2510
2511
2512
2513
2514
2515 sdkp->capacity = 0;
2516
2517
2518
2519
2520
2521
2522 sector_size = 512;
2523 }
2524 blk_queue_logical_block_size(sdp->request_queue, sector_size);
2525 blk_queue_physical_block_size(sdp->request_queue,
2526 sdkp->physical_block_size);
2527 sdkp->device->sector_size = sector_size;
2528
2529 if (sdkp->capacity > 0xffffffff)
2530 sdp->use_16_for_rw = 1;
2531
2532 }
2533
2534
2535
2536
2537 static void
2538 sd_print_capacity(struct scsi_disk *sdkp,
2539 sector_t old_capacity)
2540 {
2541 int sector_size = sdkp->device->sector_size;
2542 char cap_str_2[10], cap_str_10[10];
2543
2544 if (!sdkp->first_scan && old_capacity == sdkp->capacity)
2545 return;
2546
2547 string_get_size(sdkp->capacity, sector_size,
2548 STRING_UNITS_2, cap_str_2, sizeof(cap_str_2));
2549 string_get_size(sdkp->capacity, sector_size,
2550 STRING_UNITS_10, cap_str_10, sizeof(cap_str_10));
2551
2552 sd_printk(KERN_NOTICE, sdkp,
2553 "%llu %d-byte logical blocks: (%s/%s)\n",
2554 (unsigned long long)sdkp->capacity,
2555 sector_size, cap_str_10, cap_str_2);
2556
2557 if (sdkp->physical_block_size != sector_size)
2558 sd_printk(KERN_NOTICE, sdkp,
2559 "%u-byte physical blocks\n",
2560 sdkp->physical_block_size);
2561
2562 sd_zbc_print_zones(sdkp);
2563 }
2564
2565
2566 static inline int
2567 sd_do_mode_sense(struct scsi_device *sdp, int dbd, int modepage,
2568 unsigned char *buffer, int len, struct scsi_mode_data *data,
2569 struct scsi_sense_hdr *sshdr)
2570 {
2571 return scsi_mode_sense(sdp, dbd, modepage, buffer, len,
2572 SD_TIMEOUT, SD_MAX_RETRIES, data,
2573 sshdr);
2574 }
2575
2576
2577
2578
2579
2580 static void
2581 sd_read_write_protect_flag(struct scsi_disk *sdkp, unsigned char *buffer)
2582 {
2583 int res;
2584 struct scsi_device *sdp = sdkp->device;
2585 struct scsi_mode_data data;
2586 int old_wp = sdkp->write_prot;
2587
2588 set_disk_ro(sdkp->disk, 0);
2589 if (sdp->skip_ms_page_3f) {
2590 sd_first_printk(KERN_NOTICE, sdkp, "Assuming Write Enabled\n");
2591 return;
2592 }
2593
2594 if (sdp->use_192_bytes_for_3f) {
2595 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 192, &data, NULL);
2596 } else {
2597
2598
2599
2600
2601
2602 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 4, &data, NULL);
2603
2604
2605
2606
2607
2608
2609
2610 if (!scsi_status_is_good(res))
2611 res = sd_do_mode_sense(sdp, 0, 0, buffer, 4, &data, NULL);
2612
2613
2614
2615
2616 if (!scsi_status_is_good(res))
2617 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 255,
2618 &data, NULL);
2619 }
2620
2621 if (!scsi_status_is_good(res)) {
2622 sd_first_printk(KERN_WARNING, sdkp,
2623 "Test WP failed, assume Write Enabled\n");
2624 } else {
2625 sdkp->write_prot = ((data.device_specific & 0x80) != 0);
2626 set_disk_ro(sdkp->disk, sdkp->write_prot);
2627 if (sdkp->first_scan || old_wp != sdkp->write_prot) {
2628 sd_printk(KERN_NOTICE, sdkp, "Write Protect is %s\n",
2629 sdkp->write_prot ? "on" : "off");
2630 sd_printk(KERN_DEBUG, sdkp, "Mode Sense: %4ph\n", buffer);
2631 }
2632 }
2633 }
2634
2635
2636
2637
2638
2639 static void
2640 sd_read_cache_type(struct scsi_disk *sdkp, unsigned char *buffer)
2641 {
2642 int len = 0, res;
2643 struct scsi_device *sdp = sdkp->device;
2644
2645 int dbd;
2646 int modepage;
2647 int first_len;
2648 struct scsi_mode_data data;
2649 struct scsi_sense_hdr sshdr;
2650 int old_wce = sdkp->WCE;
2651 int old_rcd = sdkp->RCD;
2652 int old_dpofua = sdkp->DPOFUA;
2653
2654
2655 if (sdkp->cache_override)
2656 return;
2657
2658 first_len = 4;
2659 if (sdp->skip_ms_page_8) {
2660 if (sdp->type == TYPE_RBC)
2661 goto defaults;
2662 else {
2663 if (sdp->skip_ms_page_3f)
2664 goto defaults;
2665 modepage = 0x3F;
2666 if (sdp->use_192_bytes_for_3f)
2667 first_len = 192;
2668 dbd = 0;
2669 }
2670 } else if (sdp->type == TYPE_RBC) {
2671 modepage = 6;
2672 dbd = 8;
2673 } else {
2674 modepage = 8;
2675 dbd = 0;
2676 }
2677
2678
2679 res = sd_do_mode_sense(sdp, dbd, modepage, buffer, first_len,
2680 &data, &sshdr);
2681
2682 if (!scsi_status_is_good(res))
2683 goto bad_sense;
2684
2685 if (!data.header_length) {
2686 modepage = 6;
2687 first_len = 0;
2688 sd_first_printk(KERN_ERR, sdkp,
2689 "Missing header in MODE_SENSE response\n");
2690 }
2691
2692
2693 len = data.length;
2694
2695
2696
2697
2698
2699 if (len < 3)
2700 goto bad_sense;
2701 else if (len > SD_BUF_SIZE) {
2702 sd_first_printk(KERN_NOTICE, sdkp, "Truncating mode parameter "
2703 "data from %d to %d bytes\n", len, SD_BUF_SIZE);
2704 len = SD_BUF_SIZE;
2705 }
2706 if (modepage == 0x3F && sdp->use_192_bytes_for_3f)
2707 len = 192;
2708
2709
2710 if (len > first_len)
2711 res = sd_do_mode_sense(sdp, dbd, modepage, buffer, len,
2712 &data, &sshdr);
2713
2714 if (scsi_status_is_good(res)) {
2715 int offset = data.header_length + data.block_descriptor_length;
2716
2717 while (offset < len) {
2718 u8 page_code = buffer[offset] & 0x3F;
2719 u8 spf = buffer[offset] & 0x40;
2720
2721 if (page_code == 8 || page_code == 6) {
2722
2723
2724 if (len - offset <= 2) {
2725 sd_first_printk(KERN_ERR, sdkp,
2726 "Incomplete mode parameter "
2727 "data\n");
2728 goto defaults;
2729 } else {
2730 modepage = page_code;
2731 goto Page_found;
2732 }
2733 } else {
2734
2735 if (spf && len - offset > 3)
2736 offset += 4 + (buffer[offset+2] << 8) +
2737 buffer[offset+3];
2738 else if (!spf && len - offset > 1)
2739 offset += 2 + buffer[offset+1];
2740 else {
2741 sd_first_printk(KERN_ERR, sdkp,
2742 "Incomplete mode "
2743 "parameter data\n");
2744 goto defaults;
2745 }
2746 }
2747 }
2748
2749 sd_first_printk(KERN_ERR, sdkp, "No Caching mode page found\n");
2750 goto defaults;
2751
2752 Page_found:
2753 if (modepage == 8) {
2754 sdkp->WCE = ((buffer[offset + 2] & 0x04) != 0);
2755 sdkp->RCD = ((buffer[offset + 2] & 0x01) != 0);
2756 } else {
2757 sdkp->WCE = ((buffer[offset + 2] & 0x01) == 0);
2758 sdkp->RCD = 0;
2759 }
2760
2761 sdkp->DPOFUA = (data.device_specific & 0x10) != 0;
2762 if (sdp->broken_fua) {
2763 sd_first_printk(KERN_NOTICE, sdkp, "Disabling FUA\n");
2764 sdkp->DPOFUA = 0;
2765 } else if (sdkp->DPOFUA && !sdkp->device->use_10_for_rw &&
2766 !sdkp->device->use_16_for_rw) {
2767 sd_first_printk(KERN_NOTICE, sdkp,
2768 "Uses READ/WRITE(6), disabling FUA\n");
2769 sdkp->DPOFUA = 0;
2770 }
2771
2772
2773 if (sdkp->WCE && sdkp->write_prot)
2774 sdkp->WCE = 0;
2775
2776 if (sdkp->first_scan || old_wce != sdkp->WCE ||
2777 old_rcd != sdkp->RCD || old_dpofua != sdkp->DPOFUA)
2778 sd_printk(KERN_NOTICE, sdkp,
2779 "Write cache: %s, read cache: %s, %s\n",
2780 sdkp->WCE ? "enabled" : "disabled",
2781 sdkp->RCD ? "disabled" : "enabled",
2782 sdkp->DPOFUA ? "supports DPO and FUA"
2783 : "doesn't support DPO or FUA");
2784
2785 return;
2786 }
2787
2788 bad_sense:
2789 if (scsi_sense_valid(&sshdr) &&
2790 sshdr.sense_key == ILLEGAL_REQUEST &&
2791 sshdr.asc == 0x24 && sshdr.ascq == 0x0)
2792
2793 sd_first_printk(KERN_NOTICE, sdkp, "Cache data unavailable\n");
2794 else
2795 sd_first_printk(KERN_ERR, sdkp,
2796 "Asking for cache data failed\n");
2797
2798 defaults:
2799 if (sdp->wce_default_on) {
2800 sd_first_printk(KERN_NOTICE, sdkp,
2801 "Assuming drive cache: write back\n");
2802 sdkp->WCE = 1;
2803 } else {
2804 sd_first_printk(KERN_ERR, sdkp,
2805 "Assuming drive cache: write through\n");
2806 sdkp->WCE = 0;
2807 }
2808 sdkp->RCD = 0;
2809 sdkp->DPOFUA = 0;
2810 }
2811
2812
2813
2814
2815
2816 static void sd_read_app_tag_own(struct scsi_disk *sdkp, unsigned char *buffer)
2817 {
2818 int res, offset;
2819 struct scsi_device *sdp = sdkp->device;
2820 struct scsi_mode_data data;
2821 struct scsi_sense_hdr sshdr;
2822
2823 if (sdp->type != TYPE_DISK && sdp->type != TYPE_ZBC)
2824 return;
2825
2826 if (sdkp->protection_type == 0)
2827 return;
2828
2829 res = scsi_mode_sense(sdp, 1, 0x0a, buffer, 36, SD_TIMEOUT,
2830 SD_MAX_RETRIES, &data, &sshdr);
2831
2832 if (!scsi_status_is_good(res) || !data.header_length ||
2833 data.length < 6) {
2834 sd_first_printk(KERN_WARNING, sdkp,
2835 "getting Control mode page failed, assume no ATO\n");
2836
2837 if (scsi_sense_valid(&sshdr))
2838 sd_print_sense_hdr(sdkp, &sshdr);
2839
2840 return;
2841 }
2842
2843 offset = data.header_length + data.block_descriptor_length;
2844
2845 if ((buffer[offset] & 0x3f) != 0x0a) {
2846 sd_first_printk(KERN_ERR, sdkp, "ATO Got wrong page\n");
2847 return;
2848 }
2849
2850 if ((buffer[offset + 5] & 0x80) == 0)
2851 return;
2852
2853 sdkp->ATO = 1;
2854
2855 return;
2856 }
2857
2858
2859
2860
2861
2862 static void sd_read_block_limits(struct scsi_disk *sdkp)
2863 {
2864 unsigned int sector_sz = sdkp->device->sector_size;
2865 const int vpd_len = 64;
2866 unsigned char *buffer = kmalloc(vpd_len, GFP_KERNEL);
2867
2868 if (!buffer ||
2869
2870 scsi_get_vpd_page(sdkp->device, 0xb0, buffer, vpd_len))
2871 goto out;
2872
2873 blk_queue_io_min(sdkp->disk->queue,
2874 get_unaligned_be16(&buffer[6]) * sector_sz);
2875
2876 sdkp->max_xfer_blocks = get_unaligned_be32(&buffer[8]);
2877 sdkp->opt_xfer_blocks = get_unaligned_be32(&buffer[12]);
2878
2879 if (buffer[3] == 0x3c) {
2880 unsigned int lba_count, desc_count;
2881
2882 sdkp->max_ws_blocks = (u32)get_unaligned_be64(&buffer[36]);
2883
2884 if (!sdkp->lbpme)
2885 goto out;
2886
2887 lba_count = get_unaligned_be32(&buffer[20]);
2888 desc_count = get_unaligned_be32(&buffer[24]);
2889
2890 if (lba_count && desc_count)
2891 sdkp->max_unmap_blocks = lba_count;
2892
2893 sdkp->unmap_granularity = get_unaligned_be32(&buffer[28]);
2894
2895 if (buffer[32] & 0x80)
2896 sdkp->unmap_alignment =
2897 get_unaligned_be32(&buffer[32]) & ~(1 << 31);
2898
2899 if (!sdkp->lbpvpd) {
2900
2901 if (sdkp->max_unmap_blocks)
2902 sd_config_discard(sdkp, SD_LBP_UNMAP);
2903 else
2904 sd_config_discard(sdkp, SD_LBP_WS16);
2905
2906 } else {
2907 if (sdkp->lbpu && sdkp->max_unmap_blocks)
2908 sd_config_discard(sdkp, SD_LBP_UNMAP);
2909 else if (sdkp->lbpws)
2910 sd_config_discard(sdkp, SD_LBP_WS16);
2911 else if (sdkp->lbpws10)
2912 sd_config_discard(sdkp, SD_LBP_WS10);
2913 else
2914 sd_config_discard(sdkp, SD_LBP_DISABLE);
2915 }
2916 }
2917
2918 out:
2919 kfree(buffer);
2920 }
2921
2922
2923
2924
2925
2926 static void sd_read_block_characteristics(struct scsi_disk *sdkp)
2927 {
2928 struct request_queue *q = sdkp->disk->queue;
2929 unsigned char *buffer;
2930 u16 rot;
2931 const int vpd_len = 64;
2932
2933 buffer = kmalloc(vpd_len, GFP_KERNEL);
2934
2935 if (!buffer ||
2936
2937 scsi_get_vpd_page(sdkp->device, 0xb1, buffer, vpd_len))
2938 goto out;
2939
2940 rot = get_unaligned_be16(&buffer[4]);
2941
2942 if (rot == 1) {
2943 blk_queue_flag_set(QUEUE_FLAG_NONROT, q);
2944 blk_queue_flag_clear(QUEUE_FLAG_ADD_RANDOM, q);
2945 }
2946
2947 if (sdkp->device->type == TYPE_ZBC) {
2948
2949 q->limits.zoned = BLK_ZONED_HM;
2950 } else {
2951 sdkp->zoned = (buffer[8] >> 4) & 3;
2952 if (sdkp->zoned == 1)
2953
2954 q->limits.zoned = BLK_ZONED_HA;
2955 else
2956
2957
2958
2959
2960 q->limits.zoned = BLK_ZONED_NONE;
2961 }
2962 if (blk_queue_is_zoned(q) && sdkp->first_scan)
2963 sd_printk(KERN_NOTICE, sdkp, "Host-%s zoned block device\n",
2964 q->limits.zoned == BLK_ZONED_HM ? "managed" : "aware");
2965
2966 out:
2967 kfree(buffer);
2968 }
2969
2970
2971
2972
2973
2974 static void sd_read_block_provisioning(struct scsi_disk *sdkp)
2975 {
2976 unsigned char *buffer;
2977 const int vpd_len = 8;
2978
2979 if (sdkp->lbpme == 0)
2980 return;
2981
2982 buffer = kmalloc(vpd_len, GFP_KERNEL);
2983
2984 if (!buffer || scsi_get_vpd_page(sdkp->device, 0xb2, buffer, vpd_len))
2985 goto out;
2986
2987 sdkp->lbpvpd = 1;
2988 sdkp->lbpu = (buffer[5] >> 7) & 1;
2989 sdkp->lbpws = (buffer[5] >> 6) & 1;
2990 sdkp->lbpws10 = (buffer[5] >> 5) & 1;
2991
2992 out:
2993 kfree(buffer);
2994 }
2995
2996 static void sd_read_write_same(struct scsi_disk *sdkp, unsigned char *buffer)
2997 {
2998 struct scsi_device *sdev = sdkp->device;
2999
3000 if (sdev->host->no_write_same) {
3001 sdev->no_write_same = 1;
3002
3003 return;
3004 }
3005
3006 if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, INQUIRY) < 0) {
3007
3008 int vpd_buf_len = 64;
3009
3010 sdev->no_report_opcodes = 1;
3011
3012
3013
3014
3015
3016 if (!scsi_get_vpd_page(sdev, 0x89, buffer, vpd_buf_len))
3017 sdev->no_write_same = 1;
3018 }
3019
3020 if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME_16) == 1)
3021 sdkp->ws16 = 1;
3022
3023 if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME) == 1)
3024 sdkp->ws10 = 1;
3025 }
3026
3027 static void sd_read_security(struct scsi_disk *sdkp, unsigned char *buffer)
3028 {
3029 struct scsi_device *sdev = sdkp->device;
3030
3031 if (!sdev->security_supported)
3032 return;
3033
3034 if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE,
3035 SECURITY_PROTOCOL_IN) == 1 &&
3036 scsi_report_opcode(sdev, buffer, SD_BUF_SIZE,
3037 SECURITY_PROTOCOL_OUT) == 1)
3038 sdkp->security = 1;
3039 }
3040
3041
3042
3043
3044
3045
3046 static bool sd_validate_opt_xfer_size(struct scsi_disk *sdkp,
3047 unsigned int dev_max)
3048 {
3049 struct scsi_device *sdp = sdkp->device;
3050 unsigned int opt_xfer_bytes =
3051 logical_to_bytes(sdp, sdkp->opt_xfer_blocks);
3052
3053 if (sdkp->opt_xfer_blocks == 0)
3054 return false;
3055
3056 if (sdkp->opt_xfer_blocks > dev_max) {
3057 sd_first_printk(KERN_WARNING, sdkp,
3058 "Optimal transfer size %u logical blocks " \
3059 "> dev_max (%u logical blocks)\n",
3060 sdkp->opt_xfer_blocks, dev_max);
3061 return false;
3062 }
3063
3064 if (sdkp->opt_xfer_blocks > SD_DEF_XFER_BLOCKS) {
3065 sd_first_printk(KERN_WARNING, sdkp,
3066 "Optimal transfer size %u logical blocks " \
3067 "> sd driver limit (%u logical blocks)\n",
3068 sdkp->opt_xfer_blocks, SD_DEF_XFER_BLOCKS);
3069 return false;
3070 }
3071
3072 if (opt_xfer_bytes < PAGE_SIZE) {
3073 sd_first_printk(KERN_WARNING, sdkp,
3074 "Optimal transfer size %u bytes < " \
3075 "PAGE_SIZE (%u bytes)\n",
3076 opt_xfer_bytes, (unsigned int)PAGE_SIZE);
3077 return false;
3078 }
3079
3080 if (opt_xfer_bytes & (sdkp->physical_block_size - 1)) {
3081 sd_first_printk(KERN_WARNING, sdkp,
3082 "Optimal transfer size %u bytes not a " \
3083 "multiple of physical block size (%u bytes)\n",
3084 opt_xfer_bytes, sdkp->physical_block_size);
3085 return false;
3086 }
3087
3088 sd_first_printk(KERN_INFO, sdkp, "Optimal transfer size %u bytes\n",
3089 opt_xfer_bytes);
3090 return true;
3091 }
3092
3093
3094
3095
3096
3097
3098 static int sd_revalidate_disk(struct gendisk *disk)
3099 {
3100 struct scsi_disk *sdkp = scsi_disk(disk);
3101 struct scsi_device *sdp = sdkp->device;
3102 struct request_queue *q = sdkp->disk->queue;
3103 sector_t old_capacity = sdkp->capacity;
3104 unsigned char *buffer;
3105 unsigned int dev_max, rw_max;
3106
3107 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp,
3108 "sd_revalidate_disk\n"));
3109
3110
3111
3112
3113
3114 if (!scsi_device_online(sdp))
3115 goto out;
3116
3117 buffer = kmalloc(SD_BUF_SIZE, GFP_KERNEL);
3118 if (!buffer) {
3119 sd_printk(KERN_WARNING, sdkp, "sd_revalidate_disk: Memory "
3120 "allocation failure.\n");
3121 goto out;
3122 }
3123
3124 sd_spinup_disk(sdkp);
3125
3126
3127
3128
3129
3130 if (sdkp->media_present) {
3131 sd_read_capacity(sdkp, buffer);
3132
3133
3134
3135
3136
3137
3138
3139 blk_queue_flag_clear(QUEUE_FLAG_NONROT, q);
3140 blk_queue_flag_set(QUEUE_FLAG_ADD_RANDOM, q);
3141
3142 if (scsi_device_supports_vpd(sdp)) {
3143 sd_read_block_provisioning(sdkp);
3144 sd_read_block_limits(sdkp);
3145 sd_read_block_characteristics(sdkp);
3146 sd_zbc_read_zones(sdkp, buffer);
3147 }
3148
3149 sd_print_capacity(sdkp, old_capacity);
3150
3151 sd_read_write_protect_flag(sdkp, buffer);
3152 sd_read_cache_type(sdkp, buffer);
3153 sd_read_app_tag_own(sdkp, buffer);
3154 sd_read_write_same(sdkp, buffer);
3155 sd_read_security(sdkp, buffer);
3156 }
3157
3158
3159
3160
3161
3162 sd_set_flush_flag(sdkp);
3163
3164
3165 dev_max = sdp->use_16_for_rw ? SD_MAX_XFER_BLOCKS : SD_DEF_XFER_BLOCKS;
3166
3167
3168 dev_max = min_not_zero(dev_max, sdkp->max_xfer_blocks);
3169 q->limits.max_dev_sectors = logical_to_sectors(sdp, dev_max);
3170
3171 if (sd_validate_opt_xfer_size(sdkp, dev_max)) {
3172 q->limits.io_opt = logical_to_bytes(sdp, sdkp->opt_xfer_blocks);
3173 rw_max = logical_to_sectors(sdp, sdkp->opt_xfer_blocks);
3174 } else {
3175 q->limits.io_opt = 0;
3176 rw_max = min_not_zero(logical_to_sectors(sdp, dev_max),
3177 (sector_t)BLK_DEF_MAX_SECTORS);
3178 }
3179
3180
3181 rw_max = min(rw_max, queue_max_hw_sectors(q));
3182
3183
3184
3185
3186
3187 if (sdkp->first_scan ||
3188 q->limits.max_sectors > q->limits.max_dev_sectors ||
3189 q->limits.max_sectors > q->limits.max_hw_sectors)
3190 q->limits.max_sectors = rw_max;
3191
3192 sdkp->first_scan = 0;
3193
3194 set_capacity(disk, logical_to_sectors(sdp, sdkp->capacity));
3195 sd_config_write_same(sdkp);
3196 kfree(buffer);
3197
3198 out:
3199 return 0;
3200 }
3201
3202
3203
3204
3205
3206
3207
3208
3209
3210
3211
3212
3213
3214 static void sd_unlock_native_capacity(struct gendisk *disk)
3215 {
3216 struct scsi_device *sdev = scsi_disk(disk)->device;
3217
3218 if (sdev->host->hostt->unlock_native_capacity)
3219 sdev->host->hostt->unlock_native_capacity(sdev);
3220 }
3221
3222
3223
3224
3225
3226
3227
3228
3229
3230
3231
3232
3233
3234
3235
3236
3237
3238
3239
3240
3241
3242
3243
3244 static int sd_format_disk_name(char *prefix, int index, char *buf, int buflen)
3245 {
3246 const int base = 'z' - 'a' + 1;
3247 char *begin = buf + strlen(prefix);
3248 char *end = buf + buflen;
3249 char *p;
3250 int unit;
3251
3252 p = end - 1;
3253 *p = '\0';
3254 unit = base;
3255 do {
3256 if (p == begin)
3257 return -EINVAL;
3258 *--p = 'a' + (index % unit);
3259 index = (index / unit) - 1;
3260 } while (index >= 0);
3261
3262 memmove(begin, p, end - p);
3263 memcpy(buf, prefix, strlen(prefix));
3264
3265 return 0;
3266 }
3267
3268
3269
3270
3271
3272
3273
3274
3275
3276
3277
3278
3279
3280
3281
3282
3283
3284
3285
3286 static int sd_probe(struct device *dev)
3287 {
3288 struct scsi_device *sdp = to_scsi_device(dev);
3289 struct scsi_disk *sdkp;
3290 struct gendisk *gd;
3291 int index;
3292 int error;
3293
3294 scsi_autopm_get_device(sdp);
3295 error = -ENODEV;
3296 if (sdp->type != TYPE_DISK &&
3297 sdp->type != TYPE_ZBC &&
3298 sdp->type != TYPE_MOD &&
3299 sdp->type != TYPE_RBC)
3300 goto out;
3301
3302 #ifndef CONFIG_BLK_DEV_ZONED
3303 if (sdp->type == TYPE_ZBC)
3304 goto out;
3305 #endif
3306 SCSI_LOG_HLQUEUE(3, sdev_printk(KERN_INFO, sdp,
3307 "sd_probe\n"));
3308
3309 error = -ENOMEM;
3310 sdkp = kzalloc(sizeof(*sdkp), GFP_KERNEL);
3311 if (!sdkp)
3312 goto out;
3313
3314 gd = alloc_disk(SD_MINORS);
3315 if (!gd)
3316 goto out_free;
3317
3318 index = ida_alloc(&sd_index_ida, GFP_KERNEL);
3319 if (index < 0) {
3320 sdev_printk(KERN_WARNING, sdp, "sd_probe: memory exhausted.\n");
3321 goto out_put;
3322 }
3323
3324 error = sd_format_disk_name("sd", index, gd->disk_name, DISK_NAME_LEN);
3325 if (error) {
3326 sdev_printk(KERN_WARNING, sdp, "SCSI disk (sd) name length exceeded.\n");
3327 goto out_free_index;
3328 }
3329
3330 sdkp->device = sdp;
3331 sdkp->driver = &sd_template;
3332 sdkp->disk = gd;
3333 sdkp->index = index;
3334 atomic_set(&sdkp->openers, 0);
3335 atomic_set(&sdkp->device->ioerr_cnt, 0);
3336
3337 if (!sdp->request_queue->rq_timeout) {
3338 if (sdp->type != TYPE_MOD)
3339 blk_queue_rq_timeout(sdp->request_queue, SD_TIMEOUT);
3340 else
3341 blk_queue_rq_timeout(sdp->request_queue,
3342 SD_MOD_TIMEOUT);
3343 }
3344
3345 device_initialize(&sdkp->dev);
3346 sdkp->dev.parent = dev;
3347 sdkp->dev.class = &sd_disk_class;
3348 dev_set_name(&sdkp->dev, "%s", dev_name(dev));
3349
3350 error = device_add(&sdkp->dev);
3351 if (error)
3352 goto out_free_index;
3353
3354 get_device(dev);
3355 dev_set_drvdata(dev, sdkp);
3356
3357 gd->major = sd_major((index & 0xf0) >> 4);
3358 gd->first_minor = ((index & 0xf) << 4) | (index & 0xfff00);
3359
3360 gd->fops = &sd_fops;
3361 gd->private_data = &sdkp->driver;
3362 gd->queue = sdkp->device->request_queue;
3363
3364
3365 sdp->sector_size = 512;
3366 sdkp->capacity = 0;
3367 sdkp->media_present = 1;
3368 sdkp->write_prot = 0;
3369 sdkp->cache_override = 0;
3370 sdkp->WCE = 0;
3371 sdkp->RCD = 0;
3372 sdkp->ATO = 0;
3373 sdkp->first_scan = 1;
3374 sdkp->max_medium_access_timeouts = SD_MAX_MEDIUM_TIMEOUTS;
3375
3376 sd_revalidate_disk(gd);
3377
3378 gd->flags = GENHD_FL_EXT_DEVT;
3379 if (sdp->removable) {
3380 gd->flags |= GENHD_FL_REMOVABLE;
3381 gd->events |= DISK_EVENT_MEDIA_CHANGE;
3382 gd->event_flags = DISK_EVENT_FLAG_POLL | DISK_EVENT_FLAG_UEVENT;
3383 }
3384
3385 blk_pm_runtime_init(sdp->request_queue, dev);
3386 device_add_disk(dev, gd, NULL);
3387 if (sdkp->capacity)
3388 sd_dif_config_host(sdkp);
3389
3390 sd_revalidate_disk(gd);
3391
3392 if (sdkp->security) {
3393 sdkp->opal_dev = init_opal_dev(sdp, &sd_sec_submit);
3394 if (sdkp->opal_dev)
3395 sd_printk(KERN_NOTICE, sdkp, "supports TCG Opal\n");
3396 }
3397
3398 sd_printk(KERN_NOTICE, sdkp, "Attached SCSI %sdisk\n",
3399 sdp->removable ? "removable " : "");
3400 scsi_autopm_put_device(sdp);
3401
3402 return 0;
3403
3404 out_free_index:
3405 ida_free(&sd_index_ida, index);
3406 out_put:
3407 put_disk(gd);
3408 out_free:
3409 kfree(sdkp);
3410 out:
3411 scsi_autopm_put_device(sdp);
3412 return error;
3413 }
3414
3415
3416
3417
3418
3419
3420
3421
3422
3423
3424
3425
3426 static int sd_remove(struct device *dev)
3427 {
3428 struct scsi_disk *sdkp;
3429 dev_t devt;
3430
3431 sdkp = dev_get_drvdata(dev);
3432 devt = disk_devt(sdkp->disk);
3433 scsi_autopm_get_device(sdkp->device);
3434
3435 async_synchronize_full_domain(&scsi_sd_pm_domain);
3436 device_del(&sdkp->dev);
3437 del_gendisk(sdkp->disk);
3438 sd_shutdown(dev);
3439
3440 free_opal_dev(sdkp->opal_dev);
3441
3442 blk_register_region(devt, SD_MINORS, NULL,
3443 sd_default_probe, NULL, NULL);
3444
3445 mutex_lock(&sd_ref_mutex);
3446 dev_set_drvdata(dev, NULL);
3447 put_device(&sdkp->dev);
3448 mutex_unlock(&sd_ref_mutex);
3449
3450 return 0;
3451 }
3452
3453
3454
3455
3456
3457
3458
3459
3460
3461
3462 static void scsi_disk_release(struct device *dev)
3463 {
3464 struct scsi_disk *sdkp = to_scsi_disk(dev);
3465 struct gendisk *disk = sdkp->disk;
3466 struct request_queue *q = disk->queue;
3467
3468 ida_free(&sd_index_ida, sdkp->index);
3469
3470
3471
3472
3473
3474
3475
3476
3477
3478 blk_mq_freeze_queue(q);
3479 blk_mq_unfreeze_queue(q);
3480
3481 disk->private_data = NULL;
3482 put_disk(disk);
3483 put_device(&sdkp->device->sdev_gendev);
3484
3485 kfree(sdkp);
3486 }
3487
3488 static int sd_start_stop_device(struct scsi_disk *sdkp, int start)
3489 {
3490 unsigned char cmd[6] = { START_STOP };
3491 struct scsi_sense_hdr sshdr;
3492 struct scsi_device *sdp = sdkp->device;
3493 int res;
3494
3495 if (start)
3496 cmd[4] |= 1;
3497
3498 if (sdp->start_stop_pwr_cond)
3499 cmd[4] |= start ? 1 << 4 : 3 << 4;
3500
3501 if (!scsi_device_online(sdp))
3502 return -ENODEV;
3503
3504 res = scsi_execute(sdp, cmd, DMA_NONE, NULL, 0, NULL, &sshdr,
3505 SD_TIMEOUT, SD_MAX_RETRIES, 0, RQF_PM, NULL);
3506 if (res) {
3507 sd_print_result(sdkp, "Start/Stop Unit failed", res);
3508 if (driver_byte(res) == DRIVER_SENSE)
3509 sd_print_sense_hdr(sdkp, &sshdr);
3510 if (scsi_sense_valid(&sshdr) &&
3511
3512 sshdr.asc == 0x3a)
3513 res = 0;
3514 }
3515
3516
3517 if (res)
3518 return -EIO;
3519
3520 return 0;
3521 }
3522
3523
3524
3525
3526
3527
3528 static void sd_shutdown(struct device *dev)
3529 {
3530 struct scsi_disk *sdkp = dev_get_drvdata(dev);
3531
3532 if (!sdkp)
3533 return;
3534
3535 if (pm_runtime_suspended(dev))
3536 return;
3537
3538 if (sdkp->WCE && sdkp->media_present) {
3539 sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
3540 sd_sync_cache(sdkp, NULL);
3541 }
3542
3543 if (system_state != SYSTEM_RESTART && sdkp->device->manage_start_stop) {
3544 sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
3545 sd_start_stop_device(sdkp, 0);
3546 }
3547 }
3548
3549 static int sd_suspend_common(struct device *dev, bool ignore_stop_errors)
3550 {
3551 struct scsi_disk *sdkp = dev_get_drvdata(dev);
3552 struct scsi_sense_hdr sshdr;
3553 int ret = 0;
3554
3555 if (!sdkp)
3556 return 0;
3557
3558 if (sdkp->WCE && sdkp->media_present) {
3559 sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
3560 ret = sd_sync_cache(sdkp, &sshdr);
3561
3562 if (ret) {
3563
3564 if (ret == -ENODEV)
3565 return 0;
3566
3567 if (!scsi_sense_valid(&sshdr) ||
3568 sshdr.sense_key != ILLEGAL_REQUEST)
3569 return ret;
3570
3571
3572
3573
3574
3575
3576 ret = 0;
3577 }
3578 }
3579
3580 if (sdkp->device->manage_start_stop) {
3581 sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
3582
3583 ret = sd_start_stop_device(sdkp, 0);
3584 if (ignore_stop_errors)
3585 ret = 0;
3586 }
3587
3588 return ret;
3589 }
3590
3591 static int sd_suspend_system(struct device *dev)
3592 {
3593 return sd_suspend_common(dev, true);
3594 }
3595
3596 static int sd_suspend_runtime(struct device *dev)
3597 {
3598 return sd_suspend_common(dev, false);
3599 }
3600
3601 static int sd_resume(struct device *dev)
3602 {
3603 struct scsi_disk *sdkp = dev_get_drvdata(dev);
3604 int ret;
3605
3606 if (!sdkp)
3607 return 0;
3608
3609 if (!sdkp->device->manage_start_stop)
3610 return 0;
3611
3612 sd_printk(KERN_NOTICE, sdkp, "Starting disk\n");
3613 ret = sd_start_stop_device(sdkp, 1);
3614 if (!ret)
3615 opal_unlock_from_suspend(sdkp->opal_dev);
3616 return ret;
3617 }
3618
3619
3620
3621
3622
3623
3624
3625 static int __init init_sd(void)
3626 {
3627 int majors = 0, i, err;
3628
3629 SCSI_LOG_HLQUEUE(3, printk("init_sd: sd driver entry point\n"));
3630
3631 for (i = 0; i < SD_MAJORS; i++) {
3632 if (register_blkdev(sd_major(i), "sd") != 0)
3633 continue;
3634 majors++;
3635 blk_register_region(sd_major(i), SD_MINORS, NULL,
3636 sd_default_probe, NULL, NULL);
3637 }
3638
3639 if (!majors)
3640 return -ENODEV;
3641
3642 err = class_register(&sd_disk_class);
3643 if (err)
3644 goto err_out;
3645
3646 sd_cdb_cache = kmem_cache_create("sd_ext_cdb", SD_EXT_CDB_SIZE,
3647 0, 0, NULL);
3648 if (!sd_cdb_cache) {
3649 printk(KERN_ERR "sd: can't init extended cdb cache\n");
3650 err = -ENOMEM;
3651 goto err_out_class;
3652 }
3653
3654 sd_cdb_pool = mempool_create_slab_pool(SD_MEMPOOL_SIZE, sd_cdb_cache);
3655 if (!sd_cdb_pool) {
3656 printk(KERN_ERR "sd: can't init extended cdb pool\n");
3657 err = -ENOMEM;
3658 goto err_out_cache;
3659 }
3660
3661 sd_page_pool = mempool_create_page_pool(SD_MEMPOOL_SIZE, 0);
3662 if (!sd_page_pool) {
3663 printk(KERN_ERR "sd: can't init discard page pool\n");
3664 err = -ENOMEM;
3665 goto err_out_ppool;
3666 }
3667
3668 err = scsi_register_driver(&sd_template.gendrv);
3669 if (err)
3670 goto err_out_driver;
3671
3672 return 0;
3673
3674 err_out_driver:
3675 mempool_destroy(sd_page_pool);
3676
3677 err_out_ppool:
3678 mempool_destroy(sd_cdb_pool);
3679
3680 err_out_cache:
3681 kmem_cache_destroy(sd_cdb_cache);
3682
3683 err_out_class:
3684 class_unregister(&sd_disk_class);
3685 err_out:
3686 for (i = 0; i < SD_MAJORS; i++)
3687 unregister_blkdev(sd_major(i), "sd");
3688 return err;
3689 }
3690
3691
3692
3693
3694
3695
3696 static void __exit exit_sd(void)
3697 {
3698 int i;
3699
3700 SCSI_LOG_HLQUEUE(3, printk("exit_sd: exiting sd driver\n"));
3701
3702 scsi_unregister_driver(&sd_template.gendrv);
3703 mempool_destroy(sd_cdb_pool);
3704 mempool_destroy(sd_page_pool);
3705 kmem_cache_destroy(sd_cdb_cache);
3706
3707 class_unregister(&sd_disk_class);
3708
3709 for (i = 0; i < SD_MAJORS; i++) {
3710 blk_unregister_region(sd_major(i), SD_MINORS);
3711 unregister_blkdev(sd_major(i), "sd");
3712 }
3713 }
3714
3715 module_init(init_sd);
3716 module_exit(exit_sd);
3717
3718 static void sd_print_sense_hdr(struct scsi_disk *sdkp,
3719 struct scsi_sense_hdr *sshdr)
3720 {
3721 scsi_print_sense_hdr(sdkp->device,
3722 sdkp->disk ? sdkp->disk->disk_name : NULL, sshdr);
3723 }
3724
3725 static void sd_print_result(const struct scsi_disk *sdkp, const char *msg,
3726 int result)
3727 {
3728 const char *hb_string = scsi_hostbyte_string(result);
3729 const char *db_string = scsi_driverbyte_string(result);
3730
3731 if (hb_string || db_string)
3732 sd_printk(KERN_INFO, sdkp,
3733 "%s: Result: hostbyte=%s driverbyte=%s\n", msg,
3734 hb_string ? hb_string : "invalid",
3735 db_string ? db_string : "invalid");
3736 else
3737 sd_printk(KERN_INFO, sdkp,
3738 "%s: Result: hostbyte=0x%02x driverbyte=0x%02x\n",
3739 msg, host_byte(result), driver_byte(result));
3740 }
3741