source: src/linux/universal/linux-3.18/drivers/scsi/sd.c @ 31885

Last change on this file since 31885 was 31885, checked in by brainslayer, 5 weeks ago

update

File size: 87.7 KB
Line 
1/*
2 *      sd.c Copyright (C) 1992 Drew Eckhardt
3 *           Copyright (C) 1993, 1994, 1995, 1999 Eric Youngdale
4 *
5 *      Linux scsi disk driver
6 *              Initial versions: Drew Eckhardt
7 *              Subsequent revisions: Eric Youngdale
8 *      Modification history:
9 *       - Drew Eckhardt <drew@colorado.edu> original
10 *       - Eric Youngdale <eric@andante.org> add scatter-gather, multiple
11 *         outstanding request, and other enhancements.
12 *         Support loadable low-level scsi drivers.
13 *       - Jirka Hanika <geo@ff.cuni.cz> support more scsi disks using
14 *         eight major numbers.
15 *       - Richard Gooch <rgooch@atnf.csiro.au> support devfs.
16 *       - Torben Mathiasen <tmm@image.dk> Resource allocation fixes in
17 *         sd_init and cleanups.
18 *       - Alex Davis <letmein@erols.com> Fix problem where partition info
19 *         not being read in sd_open. Fix problem where removable media
20 *         could be ejected after sd_open.
21 *       - Douglas Gilbert <dgilbert@interlog.com> cleanup for lk 2.5.x
22 *       - Badari Pulavarty <pbadari@us.ibm.com>, Matthew Wilcox
23 *         <willy@debian.org>, Kurt Garloff <garloff@suse.de>:
24 *         Support 32k/1M disks.
25 *
26 *      Logging policy (needs CONFIG_SCSI_LOGGING defined):
27 *       - setting up transfer: SCSI_LOG_HLQUEUE levels 1 and 2
28 *       - end of transfer (bh + scsi_lib): SCSI_LOG_HLCOMPLETE level 1
29 *       - entering sd_ioctl: SCSI_LOG_IOCTL level 1
30 *       - entering other commands: SCSI_LOG_HLQUEUE level 3
31 *      Note: when the logging level is set by the user, it must be greater
32 *      than the level indicated above to trigger output.       
33 */
34
35#include <linux/module.h>
36#include <linux/fs.h>
37#include <linux/kernel.h>
38#include <linux/mm.h>
39#include <linux/bio.h>
40#include <linux/genhd.h>
41#include <linux/hdreg.h>
42#include <linux/errno.h>
43#include <linux/idr.h>
44#include <linux/interrupt.h>
45#include <linux/init.h>
46#include <linux/blkdev.h>
47#include <linux/blkpg.h>
48#include <linux/delay.h>
49#include <linux/mutex.h>
50#include <linux/string_helpers.h>
51#include <linux/async.h>
52#include <linux/slab.h>
53#include <linux/pm_runtime.h>
54#include <asm/uaccess.h>
55#include <asm/unaligned.h>
56
57#include <scsi/scsi.h>
58#include <scsi/scsi_cmnd.h>
59#include <scsi/scsi_dbg.h>
60#include <scsi/scsi_device.h>
61#include <scsi/scsi_driver.h>
62#include <scsi/scsi_eh.h>
63#include <scsi/scsi_host.h>
64#include <scsi/scsi_ioctl.h>
65#include <scsi/scsicam.h>
66
67#include "sd.h"
68#include "scsi_priv.h"
69#include "scsi_logging.h"
70
71MODULE_AUTHOR("Eric Youngdale");
72MODULE_DESCRIPTION("SCSI disk (sd) driver");
73MODULE_LICENSE("GPL");
74
75MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK0_MAJOR);
76MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK1_MAJOR);
77MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK2_MAJOR);
78MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK3_MAJOR);
79MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK4_MAJOR);
80MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK5_MAJOR);
81MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK6_MAJOR);
82MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK7_MAJOR);
83MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK8_MAJOR);
84MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK9_MAJOR);
85MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK10_MAJOR);
86MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK11_MAJOR);
87MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK12_MAJOR);
88MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK13_MAJOR);
89MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK14_MAJOR);
90MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK15_MAJOR);
91MODULE_ALIAS_SCSI_DEVICE(TYPE_DISK);
92MODULE_ALIAS_SCSI_DEVICE(TYPE_MOD);
93MODULE_ALIAS_SCSI_DEVICE(TYPE_RBC);
94
95#if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
96#define SD_MINORS       16
97#else
98#define SD_MINORS       0
99#endif
100
101static void sd_config_discard(struct scsi_disk *, unsigned int);
102static void sd_config_write_same(struct scsi_disk *);
103static int  sd_revalidate_disk(struct gendisk *);
104static void sd_unlock_native_capacity(struct gendisk *disk);
105static int  sd_probe(struct device *);
106static int  sd_remove(struct device *);
107static void sd_shutdown(struct device *);
108static int sd_suspend_system(struct device *);
109static int sd_suspend_runtime(struct device *);
110static int sd_resume(struct device *);
111static void sd_rescan(struct device *);
112static int sd_init_command(struct scsi_cmnd *SCpnt);
113static void sd_uninit_command(struct scsi_cmnd *SCpnt);
114static int sd_done(struct scsi_cmnd *);
115static int sd_eh_action(struct scsi_cmnd *, int);
116static void sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer);
117static void scsi_disk_release(struct device *cdev);
118static void sd_print_sense_hdr(struct scsi_disk *, struct scsi_sense_hdr *);
119static void sd_print_result(struct scsi_disk *, int);
120
121static DEFINE_SPINLOCK(sd_index_lock);
122static DEFINE_IDA(sd_index_ida);
123
124/* This semaphore is used to mediate the 0->1 reference get in the
125 * face of object destruction (i.e. we can't allow a get on an
126 * object after last put) */
127static DEFINE_MUTEX(sd_ref_mutex);
128
129static struct kmem_cache *sd_cdb_cache;
130static mempool_t *sd_cdb_pool;
131
132static const char *sd_cache_types[] = {
133        "write through", "none", "write back",
134        "write back, no read (daft)"
135};
136
137static void sd_set_flush_flag(struct scsi_disk *sdkp)
138{
139        unsigned flush = 0;
140
141        if (sdkp->WCE) {
142                flush |= REQ_FLUSH;
143                if (sdkp->DPOFUA)
144                        flush |= REQ_FUA;
145        }
146
147        blk_queue_flush(sdkp->disk->queue, flush);
148}
149
150static ssize_t
151cache_type_store(struct device *dev, struct device_attribute *attr,
152                 const char *buf, size_t count)
153{
154        int i, ct = -1, rcd, wce, sp;
155        struct scsi_disk *sdkp = to_scsi_disk(dev);
156        struct scsi_device *sdp = sdkp->device;
157        char buffer[64];
158        char *buffer_data;
159        struct scsi_mode_data data;
160        struct scsi_sense_hdr sshdr;
161        static const char temp[] = "temporary ";
162        int len;
163
164        if (sdp->type != TYPE_DISK)
165                /* no cache control on RBC devices; theoretically they
166                 * can do it, but there's probably so many exceptions
167                 * it's not worth the risk */
168                return -EINVAL;
169
170        if (strncmp(buf, temp, sizeof(temp) - 1) == 0) {
171                buf += sizeof(temp) - 1;
172                sdkp->cache_override = 1;
173        } else {
174                sdkp->cache_override = 0;
175        }
176
177        for (i = 0; i < ARRAY_SIZE(sd_cache_types); i++) {
178                len = strlen(sd_cache_types[i]);
179                if (strncmp(sd_cache_types[i], buf, len) == 0 &&
180                    buf[len] == '\n') {
181                        ct = i;
182                        break;
183                }
184        }
185        if (ct < 0)
186                return -EINVAL;
187        rcd = ct & 0x01 ? 1 : 0;
188        wce = (ct & 0x02) && !sdkp->write_prot ? 1 : 0;
189
190        if (sdkp->cache_override) {
191                sdkp->WCE = wce;
192                sdkp->RCD = rcd;
193                sd_set_flush_flag(sdkp);
194                return count;
195        }
196
197        if (scsi_mode_sense(sdp, 0x08, 8, buffer, sizeof(buffer), SD_TIMEOUT,
198                            SD_MAX_RETRIES, &data, NULL))
199                return -EINVAL;
200        len = min_t(size_t, sizeof(buffer), data.length - data.header_length -
201                  data.block_descriptor_length);
202        buffer_data = buffer + data.header_length +
203                data.block_descriptor_length;
204        buffer_data[2] &= ~0x05;
205        buffer_data[2] |= wce << 2 | rcd;
206        sp = buffer_data[0] & 0x80 ? 1 : 0;
207
208        if (scsi_mode_select(sdp, 1, sp, 8, buffer_data, len, SD_TIMEOUT,
209                             SD_MAX_RETRIES, &data, &sshdr)) {
210                if (scsi_sense_valid(&sshdr))
211                        sd_print_sense_hdr(sdkp, &sshdr);
212                return -EINVAL;
213        }
214        revalidate_disk(sdkp->disk);
215        return count;
216}
217
218static ssize_t
219manage_start_stop_show(struct device *dev, struct device_attribute *attr,
220                       char *buf)
221{
222        struct scsi_disk *sdkp = to_scsi_disk(dev);
223        struct scsi_device *sdp = sdkp->device;
224
225        return snprintf(buf, 20, "%u\n", sdp->manage_start_stop);
226}
227
228static ssize_t
229manage_start_stop_store(struct device *dev, struct device_attribute *attr,
230                        const char *buf, size_t count)
231{
232        struct scsi_disk *sdkp = to_scsi_disk(dev);
233        struct scsi_device *sdp = sdkp->device;
234
235        if (!capable(CAP_SYS_ADMIN))
236                return -EACCES;
237
238        sdp->manage_start_stop = simple_strtoul(buf, NULL, 10);
239
240        return count;
241}
242static DEVICE_ATTR_RW(manage_start_stop);
243
244static ssize_t
245allow_restart_show(struct device *dev, struct device_attribute *attr, char *buf)
246{
247        struct scsi_disk *sdkp = to_scsi_disk(dev);
248
249        return snprintf(buf, 40, "%d\n", sdkp->device->allow_restart);
250}
251
252static ssize_t
253allow_restart_store(struct device *dev, struct device_attribute *attr,
254                    const char *buf, size_t count)
255{
256        struct scsi_disk *sdkp = to_scsi_disk(dev);
257        struct scsi_device *sdp = sdkp->device;
258
259        if (!capable(CAP_SYS_ADMIN))
260                return -EACCES;
261
262        if (sdp->type != TYPE_DISK)
263                return -EINVAL;
264
265        sdp->allow_restart = simple_strtoul(buf, NULL, 10);
266
267        return count;
268}
269static DEVICE_ATTR_RW(allow_restart);
270
271static ssize_t
272cache_type_show(struct device *dev, struct device_attribute *attr, char *buf)
273{
274        struct scsi_disk *sdkp = to_scsi_disk(dev);
275        int ct = sdkp->RCD + 2*sdkp->WCE;
276
277        return snprintf(buf, 40, "%s\n", sd_cache_types[ct]);
278}
279static DEVICE_ATTR_RW(cache_type);
280
281static ssize_t
282FUA_show(struct device *dev, struct device_attribute *attr, char *buf)
283{
284        struct scsi_disk *sdkp = to_scsi_disk(dev);
285
286        return snprintf(buf, 20, "%u\n", sdkp->DPOFUA);
287}
288static DEVICE_ATTR_RO(FUA);
289
290static ssize_t
291protection_type_show(struct device *dev, struct device_attribute *attr,
292                     char *buf)
293{
294        struct scsi_disk *sdkp = to_scsi_disk(dev);
295
296        return snprintf(buf, 20, "%u\n", sdkp->protection_type);
297}
298
299static ssize_t
300protection_type_store(struct device *dev, struct device_attribute *attr,
301                      const char *buf, size_t count)
302{
303        struct scsi_disk *sdkp = to_scsi_disk(dev);
304        unsigned int val;
305        int err;
306
307        if (!capable(CAP_SYS_ADMIN))
308                return -EACCES;
309
310        err = kstrtouint(buf, 10, &val);
311
312        if (err)
313                return err;
314
315        if (val >= 0 && val <= SD_DIF_TYPE3_PROTECTION)
316                sdkp->protection_type = val;
317
318        return count;
319}
320static DEVICE_ATTR_RW(protection_type);
321
322static ssize_t
323protection_mode_show(struct device *dev, struct device_attribute *attr,
324                     char *buf)
325{
326        struct scsi_disk *sdkp = to_scsi_disk(dev);
327        struct scsi_device *sdp = sdkp->device;
328        unsigned int dif, dix;
329
330        dif = scsi_host_dif_capable(sdp->host, sdkp->protection_type);
331        dix = scsi_host_dix_capable(sdp->host, sdkp->protection_type);
332
333        if (!dix && scsi_host_dix_capable(sdp->host, SD_DIF_TYPE0_PROTECTION)) {
334                dif = 0;
335                dix = 1;
336        }
337
338        if (!dif && !dix)
339                return snprintf(buf, 20, "none\n");
340
341        return snprintf(buf, 20, "%s%u\n", dix ? "dix" : "dif", dif);
342}
343static DEVICE_ATTR_RO(protection_mode);
344
345static ssize_t
346app_tag_own_show(struct device *dev, struct device_attribute *attr, char *buf)
347{
348        struct scsi_disk *sdkp = to_scsi_disk(dev);
349
350        return snprintf(buf, 20, "%u\n", sdkp->ATO);
351}
352static DEVICE_ATTR_RO(app_tag_own);
353
354static ssize_t
355thin_provisioning_show(struct device *dev, struct device_attribute *attr,
356                       char *buf)
357{
358        struct scsi_disk *sdkp = to_scsi_disk(dev);
359
360        return snprintf(buf, 20, "%u\n", sdkp->lbpme);
361}
362static DEVICE_ATTR_RO(thin_provisioning);
363
364static const char *lbp_mode[] = {
365        [SD_LBP_FULL]           = "full",
366        [SD_LBP_UNMAP]          = "unmap",
367        [SD_LBP_WS16]           = "writesame_16",
368        [SD_LBP_WS10]           = "writesame_10",
369        [SD_LBP_ZERO]           = "writesame_zero",
370        [SD_LBP_DISABLE]        = "disabled",
371};
372
373static ssize_t
374provisioning_mode_show(struct device *dev, struct device_attribute *attr,
375                       char *buf)
376{
377        struct scsi_disk *sdkp = to_scsi_disk(dev);
378
379        return snprintf(buf, 20, "%s\n", lbp_mode[sdkp->provisioning_mode]);
380}
381
382static ssize_t
383provisioning_mode_store(struct device *dev, struct device_attribute *attr,
384                        const char *buf, size_t count)
385{
386        struct scsi_disk *sdkp = to_scsi_disk(dev);
387        struct scsi_device *sdp = sdkp->device;
388
389        if (!capable(CAP_SYS_ADMIN))
390                return -EACCES;
391
392        if (sdp->type != TYPE_DISK)
393                return -EINVAL;
394
395        if (!strncmp(buf, lbp_mode[SD_LBP_UNMAP], 20))
396                sd_config_discard(sdkp, SD_LBP_UNMAP);
397        else if (!strncmp(buf, lbp_mode[SD_LBP_WS16], 20))
398                sd_config_discard(sdkp, SD_LBP_WS16);
399        else if (!strncmp(buf, lbp_mode[SD_LBP_WS10], 20))
400                sd_config_discard(sdkp, SD_LBP_WS10);
401        else if (!strncmp(buf, lbp_mode[SD_LBP_ZERO], 20))
402                sd_config_discard(sdkp, SD_LBP_ZERO);
403        else if (!strncmp(buf, lbp_mode[SD_LBP_DISABLE], 20))
404                sd_config_discard(sdkp, SD_LBP_DISABLE);
405        else
406                return -EINVAL;
407
408        return count;
409}
410static DEVICE_ATTR_RW(provisioning_mode);
411
412static ssize_t
413max_medium_access_timeouts_show(struct device *dev,
414                                struct device_attribute *attr, char *buf)
415{
416        struct scsi_disk *sdkp = to_scsi_disk(dev);
417
418        return snprintf(buf, 20, "%u\n", sdkp->max_medium_access_timeouts);
419}
420
421static ssize_t
422max_medium_access_timeouts_store(struct device *dev,
423                                 struct device_attribute *attr, const char *buf,
424                                 size_t count)
425{
426        struct scsi_disk *sdkp = to_scsi_disk(dev);
427        int err;
428
429        if (!capable(CAP_SYS_ADMIN))
430                return -EACCES;
431
432        err = kstrtouint(buf, 10, &sdkp->max_medium_access_timeouts);
433
434        return err ? err : count;
435}
436static DEVICE_ATTR_RW(max_medium_access_timeouts);
437
438static ssize_t
439max_write_same_blocks_show(struct device *dev, struct device_attribute *attr,
440                           char *buf)
441{
442        struct scsi_disk *sdkp = to_scsi_disk(dev);
443
444        return snprintf(buf, 20, "%u\n", sdkp->max_ws_blocks);
445}
446
447static ssize_t
448max_write_same_blocks_store(struct device *dev, struct device_attribute *attr,
449                            const char *buf, size_t count)
450{
451        struct scsi_disk *sdkp = to_scsi_disk(dev);
452        struct scsi_device *sdp = sdkp->device;
453        unsigned long max;
454        int err;
455
456        if (!capable(CAP_SYS_ADMIN))
457                return -EACCES;
458
459        if (sdp->type != TYPE_DISK)
460                return -EINVAL;
461
462        err = kstrtoul(buf, 10, &max);
463
464        if (err)
465                return err;
466
467        if (max == 0)
468                sdp->no_write_same = 1;
469        else if (max <= SD_MAX_WS16_BLOCKS) {
470                sdp->no_write_same = 0;
471                sdkp->max_ws_blocks = max;
472        }
473
474        sd_config_write_same(sdkp);
475
476        return count;
477}
478static DEVICE_ATTR_RW(max_write_same_blocks);
479
480static struct attribute *sd_disk_attrs[] = {
481        &dev_attr_cache_type.attr,
482        &dev_attr_FUA.attr,
483        &dev_attr_allow_restart.attr,
484        &dev_attr_manage_start_stop.attr,
485        &dev_attr_protection_type.attr,
486        &dev_attr_protection_mode.attr,
487        &dev_attr_app_tag_own.attr,
488        &dev_attr_thin_provisioning.attr,
489        &dev_attr_provisioning_mode.attr,
490        &dev_attr_max_write_same_blocks.attr,
491        &dev_attr_max_medium_access_timeouts.attr,
492        NULL,
493};
494ATTRIBUTE_GROUPS(sd_disk);
495
496static struct class sd_disk_class = {
497        .name           = "scsi_disk",
498        .owner          = THIS_MODULE,
499        .dev_release    = scsi_disk_release,
500        .dev_groups     = sd_disk_groups,
501};
502
503static const struct dev_pm_ops sd_pm_ops = {
504        .suspend                = sd_suspend_system,
505        .resume                 = sd_resume,
506        .poweroff               = sd_suspend_system,
507        .restore                = sd_resume,
508        .runtime_suspend        = sd_suspend_runtime,
509        .runtime_resume         = sd_resume,
510};
511
512static struct scsi_driver sd_template = {
513        .owner                  = THIS_MODULE,
514        .gendrv = {
515                .name           = "sd",
516                .probe          = sd_probe,
517                .remove         = sd_remove,
518                .shutdown       = sd_shutdown,
519                .pm             = &sd_pm_ops,
520        },
521        .rescan                 = sd_rescan,
522        .init_command           = sd_init_command,
523        .uninit_command         = sd_uninit_command,
524        .done                   = sd_done,
525        .eh_action              = sd_eh_action,
526};
527
528/*
529 * Dummy kobj_map->probe function.
530 * The default ->probe function will call modprobe, which is
531 * pointless as this module is already loaded.
532 */
533static struct kobject *sd_default_probe(dev_t devt, int *partno, void *data)
534{
535        return NULL;
536}
537
538/*
539 * Device no to disk mapping:
540 *
541 *       major         disc2     disc  p1
542 *   |............|.............|....|....| <- dev_t
543 *    31        20 19          8 7  4 3  0
544 *
545 * Inside a major, we have 16k disks, however mapped non-
546 * contiguously. The first 16 disks are for major0, the next
547 * ones with major1, ... Disk 256 is for major0 again, disk 272
548 * for major1, ...
549 * As we stay compatible with our numbering scheme, we can reuse
550 * the well-know SCSI majors 8, 65--71, 136--143.
551 */
552static int sd_major(int major_idx)
553{
554        switch (major_idx) {
555        case 0:
556                return SCSI_DISK0_MAJOR;
557        case 1 ... 7:
558                return SCSI_DISK1_MAJOR + major_idx - 1;
559        case 8 ... 15:
560                return SCSI_DISK8_MAJOR + major_idx - 8;
561        default:
562                BUG();
563                return 0;       /* shut up gcc */
564        }
565}
566
567static struct scsi_disk *__scsi_disk_get(struct gendisk *disk)
568{
569        struct scsi_disk *sdkp = NULL;
570
571        if (disk->private_data) {
572                sdkp = scsi_disk(disk);
573                if (scsi_device_get(sdkp->device) == 0)
574                        get_device(&sdkp->dev);
575                else
576                        sdkp = NULL;
577        }
578        return sdkp;
579}
580
581static struct scsi_disk *scsi_disk_get(struct gendisk *disk)
582{
583        struct scsi_disk *sdkp;
584
585        mutex_lock(&sd_ref_mutex);
586        sdkp = __scsi_disk_get(disk);
587        mutex_unlock(&sd_ref_mutex);
588        return sdkp;
589}
590
591static struct scsi_disk *scsi_disk_get_from_dev(struct device *dev)
592{
593        struct scsi_disk *sdkp;
594
595        mutex_lock(&sd_ref_mutex);
596        sdkp = dev_get_drvdata(dev);
597        if (sdkp)
598                sdkp = __scsi_disk_get(sdkp->disk);
599        mutex_unlock(&sd_ref_mutex);
600        return sdkp;
601}
602
603static void scsi_disk_put(struct scsi_disk *sdkp)
604{
605        struct scsi_device *sdev = sdkp->device;
606
607        mutex_lock(&sd_ref_mutex);
608        put_device(&sdkp->dev);
609        scsi_device_put(sdev);
610        mutex_unlock(&sd_ref_mutex);
611}
612
613
614
615static unsigned char sd_setup_protect_cmnd(struct scsi_cmnd *scmd,
616                                           unsigned int dix, unsigned int dif)
617{
618        struct bio *bio = scmd->request->bio;
619        unsigned int prot_op = sd_prot_op(rq_data_dir(scmd->request), dix, dif);
620        unsigned int protect = 0;
621
622        if (dix) {                              /* DIX Type 0, 1, 2, 3 */
623                if (bio_integrity_flagged(bio, BIP_IP_CHECKSUM))
624                        scmd->prot_flags |= SCSI_PROT_IP_CHECKSUM;
625
626                if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
627                        scmd->prot_flags |= SCSI_PROT_GUARD_CHECK;
628        }
629
630        if (dif != SD_DIF_TYPE3_PROTECTION) {   /* DIX/DIF Type 0, 1, 2 */
631                scmd->prot_flags |= SCSI_PROT_REF_INCREMENT;
632
633                if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
634                        scmd->prot_flags |= SCSI_PROT_REF_CHECK;
635        }
636
637        if (dif) {                              /* DIX/DIF Type 1, 2, 3 */
638                scmd->prot_flags |= SCSI_PROT_TRANSFER_PI;
639
640                if (bio_integrity_flagged(bio, BIP_DISK_NOCHECK))
641                        protect = 3 << 5;       /* Disable target PI checking */
642                else
643                        protect = 1 << 5;       /* Enable target PI checking */
644        }
645
646        scsi_set_prot_op(scmd, prot_op);
647        scsi_set_prot_type(scmd, dif);
648        scmd->prot_flags &= sd_prot_flag_mask(prot_op);
649
650        return protect;
651}
652
653static void sd_config_discard(struct scsi_disk *sdkp, unsigned int mode)
654{
655        struct request_queue *q = sdkp->disk->queue;
656        unsigned int logical_block_size = sdkp->device->sector_size;
657        unsigned int max_blocks = 0;
658
659        q->limits.discard_zeroes_data = sdkp->lbprz;
660        q->limits.discard_alignment = sdkp->unmap_alignment *
661                logical_block_size;
662        q->limits.discard_granularity =
663                max(sdkp->physical_block_size,
664                    sdkp->unmap_granularity * logical_block_size);
665
666        sdkp->provisioning_mode = mode;
667
668        switch (mode) {
669
670        case SD_LBP_DISABLE:
671                q->limits.max_discard_sectors = 0;
672                queue_flag_clear_unlocked(QUEUE_FLAG_DISCARD, q);
673                return;
674
675        case SD_LBP_UNMAP:
676                max_blocks = min_not_zero(sdkp->max_unmap_blocks,
677                                          (u32)SD_MAX_WS16_BLOCKS);
678                break;
679
680        case SD_LBP_WS16:
681                max_blocks = min_not_zero(sdkp->max_ws_blocks,
682                                          (u32)SD_MAX_WS16_BLOCKS);
683                break;
684
685        case SD_LBP_WS10:
686                max_blocks = min_not_zero(sdkp->max_ws_blocks,
687                                          (u32)SD_MAX_WS10_BLOCKS);
688                break;
689
690        case SD_LBP_ZERO:
691                max_blocks = min_not_zero(sdkp->max_ws_blocks,
692                                          (u32)SD_MAX_WS10_BLOCKS);
693                q->limits.discard_zeroes_data = 1;
694                break;
695        }
696
697        q->limits.max_discard_sectors = max_blocks * (logical_block_size >> 9);
698        queue_flag_set_unlocked(QUEUE_FLAG_DISCARD, q);
699}
700
701/**
702 * sd_setup_discard_cmnd - unmap blocks on thinly provisioned device
703 * @sdp: scsi device to operate one
704 * @rq: Request to prepare
705 *
706 * Will issue either UNMAP or WRITE SAME(16) depending on preference
707 * indicated by target device.
708 **/
709static int sd_setup_discard_cmnd(struct scsi_cmnd *cmd)
710{
711        struct request *rq = cmd->request;
712        struct scsi_device *sdp = cmd->device;
713        struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
714        sector_t sector = blk_rq_pos(rq);
715        unsigned int nr_sectors = blk_rq_sectors(rq);
716        unsigned int nr_bytes = blk_rq_bytes(rq);
717        unsigned int len;
718        int ret;
719        char *buf;
720        struct page *page;
721
722        sector >>= ilog2(sdp->sector_size) - 9;
723        nr_sectors >>= ilog2(sdp->sector_size) - 9;
724
725        page = alloc_page(GFP_ATOMIC | __GFP_ZERO);
726        if (!page)
727                return BLKPREP_DEFER;
728
729        switch (sdkp->provisioning_mode) {
730        case SD_LBP_UNMAP:
731                buf = page_address(page);
732
733                cmd->cmd_len = 10;
734                cmd->cmnd[0] = UNMAP;
735                cmd->cmnd[8] = 24;
736
737                put_unaligned_be16(6 + 16, &buf[0]);
738                put_unaligned_be16(16, &buf[2]);
739                put_unaligned_be64(sector, &buf[8]);
740                put_unaligned_be32(nr_sectors, &buf[16]);
741
742                len = 24;
743                break;
744
745        case SD_LBP_WS16:
746                cmd->cmd_len = 16;
747                cmd->cmnd[0] = WRITE_SAME_16;
748                cmd->cmnd[1] = 0x8; /* UNMAP */
749                put_unaligned_be64(sector, &cmd->cmnd[2]);
750                put_unaligned_be32(nr_sectors, &cmd->cmnd[10]);
751
752                len = sdkp->device->sector_size;
753                break;
754
755        case SD_LBP_WS10:
756        case SD_LBP_ZERO:
757                cmd->cmd_len = 10;
758                cmd->cmnd[0] = WRITE_SAME;
759                if (sdkp->provisioning_mode == SD_LBP_WS10)
760                        cmd->cmnd[1] = 0x8; /* UNMAP */
761                put_unaligned_be32(sector, &cmd->cmnd[2]);
762                put_unaligned_be16(nr_sectors, &cmd->cmnd[7]);
763
764                len = sdkp->device->sector_size;
765                break;
766
767        default:
768                ret = BLKPREP_KILL;
769                goto out;
770        }
771
772        rq->completion_data = page;
773        rq->timeout = SD_TIMEOUT;
774
775        cmd->transfersize = len;
776        cmd->allowed = SD_MAX_RETRIES;
777
778        /*
779         * Initially __data_len is set to the amount of data that needs to be
780         * transferred to the target. This amount depends on whether WRITE SAME
781         * or UNMAP is being used. After the scatterlist has been mapped by
782         * scsi_init_io() we set __data_len to the size of the area to be
783         * discarded on disk. This allows us to report completion on the full
784         * amount of blocks described by the request.
785         */
786        blk_add_request_payload(rq, page, len);
787        ret = scsi_init_io(cmd, GFP_ATOMIC);
788        rq->__data_len = nr_bytes;
789
790out:
791        if (ret != BLKPREP_OK)
792                __free_page(page);
793        return ret;
794}
795
796static void sd_config_write_same(struct scsi_disk *sdkp)
797{
798        struct request_queue *q = sdkp->disk->queue;
799        unsigned int logical_block_size = sdkp->device->sector_size;
800
801        if (sdkp->device->no_write_same) {
802                sdkp->max_ws_blocks = 0;
803                goto out;
804        }
805
806        /* Some devices can not handle block counts above 0xffff despite
807         * supporting WRITE SAME(16). Consequently we default to 64k
808         * blocks per I/O unless the device explicitly advertises a
809         * bigger limit.
810         */
811        if (sdkp->max_ws_blocks > SD_MAX_WS10_BLOCKS)
812                sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
813                                                   (u32)SD_MAX_WS16_BLOCKS);
814        else if (sdkp->ws16 || sdkp->ws10 || sdkp->device->no_report_opcodes)
815                sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
816                                                   (u32)SD_MAX_WS10_BLOCKS);
817        else {
818                sdkp->device->no_write_same = 1;
819                sdkp->max_ws_blocks = 0;
820        }
821
822out:
823        blk_queue_max_write_same_sectors(q, sdkp->max_ws_blocks *
824                                         (logical_block_size >> 9));
825}
826
827/**
828 * sd_setup_write_same_cmnd - write the same data to multiple blocks
829 * @cmd: command to prepare
830 *
831 * Will issue either WRITE SAME(10) or WRITE SAME(16) depending on
832 * preference indicated by target device.
833 **/
834static int sd_setup_write_same_cmnd(struct scsi_cmnd *cmd)
835{
836        struct request *rq = cmd->request;
837        struct scsi_device *sdp = cmd->device;
838        struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
839        struct bio *bio = rq->bio;
840        sector_t sector = blk_rq_pos(rq);
841        unsigned int nr_sectors = blk_rq_sectors(rq);
842        unsigned int nr_bytes = blk_rq_bytes(rq);
843        int ret;
844
845        if (sdkp->device->no_write_same)
846                return BLKPREP_KILL;
847
848        BUG_ON(bio_offset(bio) || bio_iovec(bio).bv_len != sdp->sector_size);
849
850        sector >>= ilog2(sdp->sector_size) - 9;
851        nr_sectors >>= ilog2(sdp->sector_size) - 9;
852
853        rq->timeout = SD_WRITE_SAME_TIMEOUT;
854
855        if (sdkp->ws16 || sector > 0xffffffff || nr_sectors > 0xffff) {
856                cmd->cmd_len = 16;
857                cmd->cmnd[0] = WRITE_SAME_16;
858                put_unaligned_be64(sector, &cmd->cmnd[2]);
859                put_unaligned_be32(nr_sectors, &cmd->cmnd[10]);
860        } else {
861                cmd->cmd_len = 10;
862                cmd->cmnd[0] = WRITE_SAME;
863                put_unaligned_be32(sector, &cmd->cmnd[2]);
864                put_unaligned_be16(nr_sectors, &cmd->cmnd[7]);
865        }
866
867        cmd->transfersize = sdp->sector_size;
868        cmd->allowed = SD_MAX_RETRIES;
869
870        /*
871         * For WRITE_SAME the data transferred in the DATA IN buffer is
872         * different from the amount of data actually written to the target.
873         *
874         * We set up __data_len to the amount of data transferred from the
875         * DATA IN buffer so that blk_rq_map_sg set up the proper S/G list
876         * to transfer a single sector of data first, but then reset it to
877         * the amount of data to be written right after so that the I/O path
878         * knows how much to actually write.
879         */
880        rq->__data_len = sdp->sector_size;
881        ret = scsi_init_io(cmd, GFP_ATOMIC);
882        rq->__data_len = nr_bytes;
883        return ret;
884}
885
886static int sd_setup_flush_cmnd(struct scsi_cmnd *cmd)
887{
888        struct request *rq = cmd->request;
889
890        /* flush requests don't perform I/O, zero the S/G table */
891        memset(&cmd->sdb, 0, sizeof(cmd->sdb));
892
893        cmd->cmnd[0] = SYNCHRONIZE_CACHE;
894        cmd->cmd_len = 10;
895        cmd->transfersize = 0;
896        cmd->allowed = SD_MAX_RETRIES;
897
898        rq->timeout = rq->q->rq_timeout * SD_FLUSH_TIMEOUT_MULTIPLIER;
899        return BLKPREP_OK;
900}
901
902static int sd_setup_read_write_cmnd(struct scsi_cmnd *SCpnt)
903{
904        struct request *rq = SCpnt->request;
905        struct scsi_device *sdp = SCpnt->device;
906        struct gendisk *disk = rq->rq_disk;
907        struct scsi_disk *sdkp;
908        sector_t block = blk_rq_pos(rq);
909        sector_t threshold;
910        unsigned int this_count = blk_rq_sectors(rq);
911        unsigned int dif, dix;
912        int ret;
913        unsigned char protect;
914
915        ret = scsi_init_io(SCpnt, GFP_ATOMIC);
916        if (ret != BLKPREP_OK)
917                goto out;
918        SCpnt = rq->special;
919        sdkp = scsi_disk(disk);
920
921        /* from here on until we're complete, any goto out
922         * is used for a killable error condition */
923        ret = BLKPREP_KILL;
924
925        SCSI_LOG_HLQUEUE(1,
926                scmd_printk(KERN_INFO, SCpnt,
927                        "%s: block=%llu, count=%d\n",
928                        __func__, (unsigned long long)block, this_count));
929
930        if (!sdp || !scsi_device_online(sdp) ||
931            block + blk_rq_sectors(rq) > get_capacity(disk)) {
932                SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
933                                                "Finishing %u sectors\n",
934                                                blk_rq_sectors(rq)));
935                SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
936                                                "Retry with 0x%p\n", SCpnt));
937                goto out;
938        }
939
940        if (sdp->changed) {
941                /*
942                 * quietly refuse to do anything to a changed disc until
943                 * the changed bit has been reset
944                 */
945                /* printk("SCSI disk has been changed or is not present. Prohibiting further I/O.\n"); */
946                goto out;
947        }
948
949        /*
950         * Some SD card readers can't handle multi-sector accesses which touch
951         * the last one or two hardware sectors.  Split accesses as needed.
952         */
953        threshold = get_capacity(disk) - SD_LAST_BUGGY_SECTORS *
954                (sdp->sector_size / 512);
955
956        if (unlikely(sdp->last_sector_bug && block + this_count > threshold)) {
957                if (block < threshold) {
958                        /* Access up to the threshold but not beyond */
959                        this_count = threshold - block;
960                } else {
961                        /* Access only a single hardware sector */
962                        this_count = sdp->sector_size / 512;
963                }
964        }
965
966        SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt, "block=%llu\n",
967                                        (unsigned long long)block));
968
969        /*
970         * If we have a 1K hardware sectorsize, prevent access to single
971         * 512 byte sectors.  In theory we could handle this - in fact
972         * the scsi cdrom driver must be able to handle this because
973         * we typically use 1K blocksizes, and cdroms typically have
974         * 2K hardware sectorsizes.  Of course, things are simpler
975         * with the cdrom, since it is read-only.  For performance
976         * reasons, the filesystems should be able to handle this
977         * and not force the scsi disk driver to use bounce buffers
978         * for this.
979         */
980        if (sdp->sector_size == 1024) {
981                if ((block & 1) || (blk_rq_sectors(rq) & 1)) {
982                        scmd_printk(KERN_ERR, SCpnt,
983                                    "Bad block number requested\n");
984                        goto out;
985                } else {
986                        block = block >> 1;
987                        this_count = this_count >> 1;
988                }
989        }
990        if (sdp->sector_size == 2048) {
991                if ((block & 3) || (blk_rq_sectors(rq) & 3)) {
992                        scmd_printk(KERN_ERR, SCpnt,
993                                    "Bad block number requested\n");
994                        goto out;
995                } else {
996                        block = block >> 2;
997                        this_count = this_count >> 2;
998                }
999        }
1000        if (sdp->sector_size == 4096) {
1001                if ((block & 7) || (blk_rq_sectors(rq) & 7)) {
1002                        scmd_printk(KERN_ERR, SCpnt,
1003                                    "Bad block number requested\n");
1004                        goto out;
1005                } else {
1006                        block = block >> 3;
1007                        this_count = this_count >> 3;
1008                }
1009        }
1010        if (rq_data_dir(rq) == WRITE) {
1011                SCpnt->cmnd[0] = WRITE_6;
1012
1013                if (blk_integrity_rq(rq))
1014                        sd_dif_prepare(SCpnt);
1015
1016        } else if (rq_data_dir(rq) == READ) {
1017                SCpnt->cmnd[0] = READ_6;
1018        } else {
1019                scmd_printk(KERN_ERR, SCpnt, "Unknown command %llx\n", (unsigned long long) rq->cmd_flags);
1020                goto out;
1021        }
1022
1023        SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
1024                                        "%s %d/%u 512 byte blocks.\n",
1025                                        (rq_data_dir(rq) == WRITE) ?
1026                                        "writing" : "reading", this_count,
1027                                        blk_rq_sectors(rq)));
1028
1029        dix = scsi_prot_sg_count(SCpnt);
1030        dif = scsi_host_dif_capable(SCpnt->device->host, sdkp->protection_type);
1031
1032        if (dif || dix)
1033                protect = sd_setup_protect_cmnd(SCpnt, dix, dif);
1034        else
1035                protect = 0;
1036
1037        if (protect && sdkp->protection_type == SD_DIF_TYPE2_PROTECTION) {
1038                SCpnt->cmnd = mempool_alloc(sd_cdb_pool, GFP_ATOMIC);
1039
1040                if (unlikely(SCpnt->cmnd == NULL)) {
1041                        ret = BLKPREP_DEFER;
1042                        goto out;
1043                }
1044
1045                SCpnt->cmd_len = SD_EXT_CDB_SIZE;
1046                memset(SCpnt->cmnd, 0, SCpnt->cmd_len);
1047                SCpnt->cmnd[0] = VARIABLE_LENGTH_CMD;
1048                SCpnt->cmnd[7] = 0x18;
1049                SCpnt->cmnd[9] = (rq_data_dir(rq) == READ) ? READ_32 : WRITE_32;
1050                SCpnt->cmnd[10] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
1051
1052                /* LBA */
1053                SCpnt->cmnd[12] = sizeof(block) > 4 ? (unsigned char) (block >> 56) & 0xff : 0;
1054                SCpnt->cmnd[13] = sizeof(block) > 4 ? (unsigned char) (block >> 48) & 0xff : 0;
1055                SCpnt->cmnd[14] = sizeof(block) > 4 ? (unsigned char) (block >> 40) & 0xff : 0;
1056                SCpnt->cmnd[15] = sizeof(block) > 4 ? (unsigned char) (block >> 32) & 0xff : 0;
1057                SCpnt->cmnd[16] = (unsigned char) (block >> 24) & 0xff;
1058                SCpnt->cmnd[17] = (unsigned char) (block >> 16) & 0xff;
1059                SCpnt->cmnd[18] = (unsigned char) (block >> 8) & 0xff;
1060                SCpnt->cmnd[19] = (unsigned char) block & 0xff;
1061
1062                /* Expected Indirect LBA */
1063                SCpnt->cmnd[20] = (unsigned char) (block >> 24) & 0xff;
1064                SCpnt->cmnd[21] = (unsigned char) (block >> 16) & 0xff;
1065                SCpnt->cmnd[22] = (unsigned char) (block >> 8) & 0xff;
1066                SCpnt->cmnd[23] = (unsigned char) block & 0xff;
1067
1068                /* Transfer length */
1069                SCpnt->cmnd[28] = (unsigned char) (this_count >> 24) & 0xff;
1070                SCpnt->cmnd[29] = (unsigned char) (this_count >> 16) & 0xff;
1071                SCpnt->cmnd[30] = (unsigned char) (this_count >> 8) & 0xff;
1072                SCpnt->cmnd[31] = (unsigned char) this_count & 0xff;
1073        } else if (sdp->use_16_for_rw || (this_count > 0xffff)) {
1074                SCpnt->cmnd[0] += READ_16 - READ_6;
1075                SCpnt->cmnd[1] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
1076                SCpnt->cmnd[2] = sizeof(block) > 4 ? (unsigned char) (block >> 56) & 0xff : 0;
1077                SCpnt->cmnd[3] = sizeof(block) > 4 ? (unsigned char) (block >> 48) & 0xff : 0;
1078                SCpnt->cmnd[4] = sizeof(block) > 4 ? (unsigned char) (block >> 40) & 0xff : 0;
1079                SCpnt->cmnd[5] = sizeof(block) > 4 ? (unsigned char) (block >> 32) & 0xff : 0;
1080                SCpnt->cmnd[6] = (unsigned char) (block >> 24) & 0xff;
1081                SCpnt->cmnd[7] = (unsigned char) (block >> 16) & 0xff;
1082                SCpnt->cmnd[8] = (unsigned char) (block >> 8) & 0xff;
1083                SCpnt->cmnd[9] = (unsigned char) block & 0xff;
1084                SCpnt->cmnd[10] = (unsigned char) (this_count >> 24) & 0xff;
1085                SCpnt->cmnd[11] = (unsigned char) (this_count >> 16) & 0xff;
1086                SCpnt->cmnd[12] = (unsigned char) (this_count >> 8) & 0xff;
1087                SCpnt->cmnd[13] = (unsigned char) this_count & 0xff;
1088                SCpnt->cmnd[14] = SCpnt->cmnd[15] = 0;
1089        } else if ((this_count > 0xff) || (block > 0x1fffff) ||
1090                   scsi_device_protection(SCpnt->device) ||
1091                   SCpnt->device->use_10_for_rw) {
1092                SCpnt->cmnd[0] += READ_10 - READ_6;
1093                SCpnt->cmnd[1] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
1094                SCpnt->cmnd[2] = (unsigned char) (block >> 24) & 0xff;
1095                SCpnt->cmnd[3] = (unsigned char) (block >> 16) & 0xff;
1096                SCpnt->cmnd[4] = (unsigned char) (block >> 8) & 0xff;
1097                SCpnt->cmnd[5] = (unsigned char) block & 0xff;
1098                SCpnt->cmnd[6] = SCpnt->cmnd[9] = 0;
1099                SCpnt->cmnd[7] = (unsigned char) (this_count >> 8) & 0xff;
1100                SCpnt->cmnd[8] = (unsigned char) this_count & 0xff;
1101        } else {
1102                if (unlikely(rq->cmd_flags & REQ_FUA)) {
1103                        /*
1104                         * This happens only if this drive failed
1105                         * 10byte rw command with ILLEGAL_REQUEST
1106                         * during operation and thus turned off
1107                         * use_10_for_rw.
1108                         */
1109                        scmd_printk(KERN_ERR, SCpnt,
1110                                    "FUA write on READ/WRITE(6) drive\n");
1111                        goto out;
1112                }
1113
1114                SCpnt->cmnd[1] |= (unsigned char) ((block >> 16) & 0x1f);
1115                SCpnt->cmnd[2] = (unsigned char) ((block >> 8) & 0xff);
1116                SCpnt->cmnd[3] = (unsigned char) block & 0xff;
1117                SCpnt->cmnd[4] = (unsigned char) this_count;
1118                SCpnt->cmnd[5] = 0;
1119        }
1120        SCpnt->sdb.length = this_count * sdp->sector_size;
1121
1122        /*
1123         * We shouldn't disconnect in the middle of a sector, so with a dumb
1124         * host adapter, it's safe to assume that we can at least transfer
1125         * this many bytes between each connect / disconnect.
1126         */
1127        SCpnt->transfersize = sdp->sector_size;
1128        SCpnt->underflow = this_count << 9;
1129        SCpnt->allowed = SD_MAX_RETRIES;
1130
1131        /*
1132         * This indicates that the command is ready from our end to be
1133         * queued.
1134         */
1135        ret = BLKPREP_OK;
1136 out:
1137        return ret;
1138}
1139
1140static int sd_init_command(struct scsi_cmnd *cmd)
1141{
1142        struct request *rq = cmd->request;
1143
1144        if (rq->cmd_flags & REQ_DISCARD)
1145                return sd_setup_discard_cmnd(cmd);
1146        else if (rq->cmd_flags & REQ_WRITE_SAME)
1147                return sd_setup_write_same_cmnd(cmd);
1148        else if (rq->cmd_flags & REQ_FLUSH)
1149                return sd_setup_flush_cmnd(cmd);
1150        else
1151                return sd_setup_read_write_cmnd(cmd);
1152}
1153
1154static void sd_uninit_command(struct scsi_cmnd *SCpnt)
1155{
1156        struct request *rq = SCpnt->request;
1157
1158        if (rq->cmd_flags & REQ_DISCARD)
1159                __free_page(rq->completion_data);
1160
1161        if (SCpnt->cmnd != rq->cmd) {
1162                mempool_free(SCpnt->cmnd, sd_cdb_pool);
1163                SCpnt->cmnd = NULL;
1164                SCpnt->cmd_len = 0;
1165        }
1166}
1167
1168/**
1169 *      sd_open - open a scsi disk device
1170 *      @inode: only i_rdev member may be used
1171 *      @filp: only f_mode and f_flags may be used
1172 *
1173 *      Returns 0 if successful. Returns a negated errno value in case
1174 *      of error.
1175 *
1176 *      Note: This can be called from a user context (e.g. fsck(1) )
1177 *      or from within the kernel (e.g. as a result of a mount(1) ).
1178 *      In the latter case @inode and @filp carry an abridged amount
1179 *      of information as noted above.
1180 *
1181 *      Locking: called with bdev->bd_mutex held.
1182 **/
1183static int sd_open(struct block_device *bdev, fmode_t mode)
1184{
1185        struct scsi_disk *sdkp = scsi_disk_get(bdev->bd_disk);
1186        struct scsi_device *sdev;
1187        int retval;
1188
1189        if (!sdkp)
1190                return -ENXIO;
1191
1192        SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_open\n"));
1193
1194        sdev = sdkp->device;
1195
1196        /*
1197         * If the device is in error recovery, wait until it is done.
1198         * If the device is offline, then disallow any access to it.
1199         */
1200        retval = -ENXIO;
1201        if (!scsi_block_when_processing_errors(sdev))
1202                goto error_out;
1203
1204        if (sdev->removable || sdkp->write_prot)
1205                check_disk_change(bdev);
1206
1207        /*
1208         * If the drive is empty, just let the open fail.
1209         */
1210        retval = -ENOMEDIUM;
1211        if (sdev->removable && !sdkp->media_present && !(mode & FMODE_NDELAY))
1212                goto error_out;
1213
1214        /*
1215         * If the device has the write protect tab set, have the open fail
1216         * if the user expects to be able to write to the thing.
1217         */
1218        retval = -EROFS;
1219        if (sdkp->write_prot && (mode & FMODE_WRITE))
1220                goto error_out;
1221
1222        /*
1223         * It is possible that the disk changing stuff resulted in
1224         * the device being taken offline.  If this is the case,
1225         * report this to the user, and don't pretend that the
1226         * open actually succeeded.
1227         */
1228        retval = -ENXIO;
1229        if (!scsi_device_online(sdev))
1230                goto error_out;
1231
1232        if ((atomic_inc_return(&sdkp->openers) == 1) && sdev->removable) {
1233                if (scsi_block_when_processing_errors(sdev))
1234                        scsi_set_medium_removal(sdev, SCSI_REMOVAL_PREVENT);
1235        }
1236
1237        return 0;
1238
1239error_out:
1240        scsi_disk_put(sdkp);
1241        return retval; 
1242}
1243
1244/**
1245 *      sd_release - invoked when the (last) close(2) is called on this
1246 *      scsi disk.
1247 *      @inode: only i_rdev member may be used
1248 *      @filp: only f_mode and f_flags may be used
1249 *
1250 *      Returns 0.
1251 *
1252 *      Note: may block (uninterruptible) if error recovery is underway
1253 *      on this disk.
1254 *
1255 *      Locking: called with bdev->bd_mutex held.
1256 **/
1257static void sd_release(struct gendisk *disk, fmode_t mode)
1258{
1259        struct scsi_disk *sdkp = scsi_disk(disk);
1260        struct scsi_device *sdev = sdkp->device;
1261
1262        SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_release\n"));
1263
1264        if (atomic_dec_return(&sdkp->openers) == 0 && sdev->removable) {
1265                if (scsi_block_when_processing_errors(sdev))
1266                        scsi_set_medium_removal(sdev, SCSI_REMOVAL_ALLOW);
1267        }
1268
1269        /*
1270         * XXX and what if there are packets in flight and this close()
1271         * XXX is followed by a "rmmod sd_mod"?
1272         */
1273
1274        scsi_disk_put(sdkp);
1275}
1276
1277static int sd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1278{
1279        struct scsi_disk *sdkp = scsi_disk(bdev->bd_disk);
1280        struct scsi_device *sdp = sdkp->device;
1281        struct Scsi_Host *host = sdp->host;
1282        sector_t capacity = logical_to_sectors(sdp, sdkp->capacity);
1283        int diskinfo[4];
1284
1285        /* default to most commonly used values */
1286        diskinfo[0] = 0x40;     /* 1 << 6 */
1287        diskinfo[1] = 0x20;     /* 1 << 5 */
1288        diskinfo[2] = capacity >> 11;
1289
1290        /* override with calculated, extended default, or driver values */
1291        if (host->hostt->bios_param)
1292                host->hostt->bios_param(sdp, bdev, capacity, diskinfo);
1293        else
1294                scsicam_bios_param(bdev, capacity, diskinfo);
1295
1296        geo->heads = diskinfo[0];
1297        geo->sectors = diskinfo[1];
1298        geo->cylinders = diskinfo[2];
1299        return 0;
1300}
1301
1302/**
1303 *      sd_ioctl - process an ioctl
1304 *      @inode: only i_rdev/i_bdev members may be used
1305 *      @filp: only f_mode and f_flags may be used
1306 *      @cmd: ioctl command number
1307 *      @arg: this is third argument given to ioctl(2) system call.
1308 *      Often contains a pointer.
1309 *
1310 *      Returns 0 if successful (some ioctls return positive numbers on
1311 *      success as well). Returns a negated errno value in case of error.
1312 *
1313 *      Note: most ioctls are forward onto the block subsystem or further
1314 *      down in the scsi subsystem.
1315 **/
1316static int sd_ioctl(struct block_device *bdev, fmode_t mode,
1317                    unsigned int cmd, unsigned long arg)
1318{
1319        struct gendisk *disk = bdev->bd_disk;
1320        struct scsi_disk *sdkp = scsi_disk(disk);
1321        struct scsi_device *sdp = sdkp->device;
1322        void __user *p = (void __user *)arg;
1323        int error;
1324   
1325        SCSI_LOG_IOCTL(1, sd_printk(KERN_INFO, sdkp, "sd_ioctl: disk=%s, "
1326                                    "cmd=0x%x\n", disk->disk_name, cmd));
1327
1328        error = scsi_verify_blk_ioctl(bdev, cmd);
1329        if (error < 0)
1330                return error;
1331
1332        /*
1333         * If we are in the middle of error recovery, don't let anyone
1334         * else try and use this device.  Also, if error recovery fails, it
1335         * may try and take the device offline, in which case all further
1336         * access to the device is prohibited.
1337         */
1338        error = scsi_nonblockable_ioctl(sdp, cmd, p,
1339                                        (mode & FMODE_NDELAY) != 0);
1340        if (!scsi_block_when_processing_errors(sdp) || !error)
1341                goto out;
1342
1343        /*
1344         * Send SCSI addressing ioctls directly to mid level, send other
1345         * ioctls to block level and then onto mid level if they can't be
1346         * resolved.
1347         */
1348        switch (cmd) {
1349                case SCSI_IOCTL_GET_IDLUN:
1350                case SCSI_IOCTL_GET_BUS_NUMBER:
1351                        error = scsi_ioctl(sdp, cmd, p);
1352                        break;
1353                default:
1354                        error = scsi_cmd_blk_ioctl(bdev, mode, cmd, p);
1355                        if (error != -ENOTTY)
1356                                break;
1357                        error = scsi_ioctl(sdp, cmd, p);
1358                        break;
1359        }
1360out:
1361        return error;
1362}
1363
1364static void set_media_not_present(struct scsi_disk *sdkp)
1365{
1366        if (sdkp->media_present)
1367                sdkp->device->changed = 1;
1368
1369        if (sdkp->device->removable) {
1370                sdkp->media_present = 0;
1371                sdkp->capacity = 0;
1372        }
1373}
1374
1375static int media_not_present(struct scsi_disk *sdkp,
1376                             struct scsi_sense_hdr *sshdr)
1377{
1378        if (!scsi_sense_valid(sshdr))
1379                return 0;
1380
1381        /* not invoked for commands that could return deferred errors */
1382        switch (sshdr->sense_key) {
1383        case UNIT_ATTENTION:
1384        case NOT_READY:
1385                /* medium not present */
1386                if (sshdr->asc == 0x3A) {
1387                        set_media_not_present(sdkp);
1388                        return 1;
1389                }
1390        }
1391        return 0;
1392}
1393
1394/**
1395 *      sd_check_events - check media events
1396 *      @disk: kernel device descriptor
1397 *      @clearing: disk events currently being cleared
1398 *
1399 *      Returns mask of DISK_EVENT_*.
1400 *
1401 *      Note: this function is invoked from the block subsystem.
1402 **/
1403static unsigned int sd_check_events(struct gendisk *disk, unsigned int clearing)
1404{
1405        struct scsi_disk *sdkp = scsi_disk(disk);
1406        struct scsi_device *sdp = sdkp->device;
1407        struct scsi_sense_hdr *sshdr = NULL;
1408        int retval;
1409
1410        SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_check_events\n"));
1411
1412        /*
1413         * If the device is offline, don't send any commands - just pretend as
1414         * if the command failed.  If the device ever comes back online, we
1415         * can deal with it then.  It is only because of unrecoverable errors
1416         * that we would ever take a device offline in the first place.
1417         */
1418        if (!scsi_device_online(sdp)) {
1419                set_media_not_present(sdkp);
1420                goto out;
1421        }
1422
1423        /*
1424         * Using TEST_UNIT_READY enables differentiation between drive with
1425         * no cartridge loaded - NOT READY, drive with changed cartridge -
1426         * UNIT ATTENTION, or with same cartridge - GOOD STATUS.
1427         *
1428         * Drives that auto spin down. eg iomega jaz 1G, will be started
1429         * by sd_spinup_disk() from sd_revalidate_disk(), which happens whenever
1430         * sd_revalidate() is called.
1431         */
1432        retval = -ENODEV;
1433
1434        if (scsi_block_when_processing_errors(sdp)) {
1435                sshdr  = kzalloc(sizeof(*sshdr), GFP_KERNEL);
1436                retval = scsi_test_unit_ready(sdp, SD_TIMEOUT, SD_MAX_RETRIES,
1437                                              sshdr);
1438        }
1439
1440        /* failed to execute TUR, assume media not present */
1441        if (host_byte(retval)) {
1442                set_media_not_present(sdkp);
1443                goto out;
1444        }
1445
1446        if (media_not_present(sdkp, sshdr))
1447                goto out;
1448
1449        /*
1450         * For removable scsi disk we have to recognise the presence
1451         * of a disk in the drive.
1452         */
1453        if (!sdkp->media_present)
1454                sdp->changed = 1;
1455        sdkp->media_present = 1;
1456out:
1457        /*
1458         * sdp->changed is set under the following conditions:
1459         *
1460         *      Medium present state has changed in either direction.
1461         *      Device has indicated UNIT_ATTENTION.
1462         */
1463        kfree(sshdr);
1464        retval = sdp->changed ? DISK_EVENT_MEDIA_CHANGE : 0;
1465        sdp->changed = 0;
1466        return retval;
1467}
1468
1469static int sd_sync_cache(struct scsi_disk *sdkp)
1470{
1471        int retries, res;
1472        struct scsi_device *sdp = sdkp->device;
1473        const int timeout = sdp->request_queue->rq_timeout
1474                * SD_FLUSH_TIMEOUT_MULTIPLIER;
1475        struct scsi_sense_hdr sshdr;
1476
1477        if (!scsi_device_online(sdp))
1478                return -ENODEV;
1479
1480        for (retries = 3; retries > 0; --retries) {
1481                unsigned char cmd[10] = { 0 };
1482
1483                cmd[0] = SYNCHRONIZE_CACHE;
1484                /*
1485                 * Leave the rest of the command zero to indicate
1486                 * flush everything.
1487                 */
1488                res = scsi_execute_req_flags(sdp, cmd, DMA_NONE, NULL, 0,
1489                                             &sshdr, timeout, SD_MAX_RETRIES,
1490                                             NULL, REQ_PM);
1491                if (res == 0)
1492                        break;
1493        }
1494
1495        if (res) {
1496                sd_print_result(sdkp, res);
1497
1498                if (driver_byte(res) & DRIVER_SENSE)
1499                        sd_print_sense_hdr(sdkp, &sshdr);
1500                /* we need to evaluate the error return  */
1501                if (scsi_sense_valid(&sshdr) &&
1502                        (sshdr.asc == 0x3a ||   /* medium not present */
1503                         sshdr.asc == 0x20))    /* invalid command */
1504                                /* this is no error here */
1505                                return 0;
1506
1507                switch (host_byte(res)) {
1508                /* ignore errors due to racing a disconnection */
1509                case DID_BAD_TARGET:
1510                case DID_NO_CONNECT:
1511                        return 0;
1512                /* signal the upper layer it might try again */
1513                case DID_BUS_BUSY:
1514                case DID_IMM_RETRY:
1515                case DID_REQUEUE:
1516                case DID_SOFT_ERROR:
1517                        return -EBUSY;
1518                default:
1519                        return -EIO;
1520                }
1521        }
1522        return 0;
1523}
1524
1525static void sd_rescan(struct device *dev)
1526{
1527        struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
1528
1529        if (sdkp) {
1530                revalidate_disk(sdkp->disk);
1531                scsi_disk_put(sdkp);
1532        }
1533}
1534
1535
1536#ifdef CONFIG_COMPAT
1537/*
1538 * This gets directly called from VFS. When the ioctl
1539 * is not recognized we go back to the other translation paths.
1540 */
1541static int sd_compat_ioctl(struct block_device *bdev, fmode_t mode,
1542                           unsigned int cmd, unsigned long arg)
1543{
1544        struct scsi_device *sdev = scsi_disk(bdev->bd_disk)->device;
1545        int ret;
1546
1547        ret = scsi_verify_blk_ioctl(bdev, cmd);
1548        if (ret < 0)
1549                return ret;
1550
1551        /*
1552         * If we are in the middle of error recovery, don't let anyone
1553         * else try and use this device.  Also, if error recovery fails, it
1554         * may try and take the device offline, in which case all further
1555         * access to the device is prohibited.
1556         */
1557        if (!scsi_block_when_processing_errors(sdev))
1558                return -ENODEV;
1559               
1560        if (sdev->host->hostt->compat_ioctl) {
1561                ret = sdev->host->hostt->compat_ioctl(sdev, cmd, (void __user *)arg);
1562
1563                return ret;
1564        }
1565
1566        /*
1567         * Let the static ioctl translation table take care of it.
1568         */
1569        return -ENOIOCTLCMD;
1570}
1571#endif
1572
1573static const struct block_device_operations sd_fops = {
1574        .owner                  = THIS_MODULE,
1575        .open                   = sd_open,
1576        .release                = sd_release,
1577        .ioctl                  = sd_ioctl,
1578        .getgeo                 = sd_getgeo,
1579#ifdef CONFIG_COMPAT
1580        .compat_ioctl           = sd_compat_ioctl,
1581#endif
1582        .check_events           = sd_check_events,
1583        .revalidate_disk        = sd_revalidate_disk,
1584        .unlock_native_capacity = sd_unlock_native_capacity,
1585};
1586
1587/**
1588 *      sd_eh_action - error handling callback
1589 *      @scmd:          sd-issued command that has failed
1590 *      @eh_disp:       The recovery disposition suggested by the midlayer
1591 *
1592 *      This function is called by the SCSI midlayer upon completion of an
1593 *      error test command (currently TEST UNIT READY). The result of sending
1594 *      the eh command is passed in eh_disp.  We're looking for devices that
1595 *      fail medium access commands but are OK with non access commands like
1596 *      test unit ready (so wrongly see the device as having a successful
1597 *      recovery)
1598 **/
1599static int sd_eh_action(struct scsi_cmnd *scmd, int eh_disp)
1600{
1601        struct scsi_disk *sdkp = scsi_disk(scmd->request->rq_disk);
1602
1603        if (!scsi_device_online(scmd->device) ||
1604            !scsi_medium_access_command(scmd) ||
1605            host_byte(scmd->result) != DID_TIME_OUT ||
1606            eh_disp != SUCCESS)
1607                return eh_disp;
1608
1609        /*
1610         * The device has timed out executing a medium access command.
1611         * However, the TEST UNIT READY command sent during error
1612         * handling completed successfully. Either the device is in the
1613         * process of recovering or has it suffered an internal failure
1614         * that prevents access to the storage medium.
1615         */
1616        sdkp->medium_access_timed_out++;
1617
1618        /*
1619         * If the device keeps failing read/write commands but TEST UNIT
1620         * READY always completes successfully we assume that medium
1621         * access is no longer possible and take the device offline.
1622         */
1623        if (sdkp->medium_access_timed_out >= sdkp->max_medium_access_timeouts) {
1624                scmd_printk(KERN_ERR, scmd,
1625                            "Medium access timeout failure. Offlining disk!\n");
1626                scsi_device_set_state(scmd->device, SDEV_OFFLINE);
1627
1628                return FAILED;
1629        }
1630
1631        return eh_disp;
1632}
1633
1634static unsigned int sd_completed_bytes(struct scsi_cmnd *scmd)
1635{
1636        u64 start_lba = blk_rq_pos(scmd->request);
1637        u64 end_lba = blk_rq_pos(scmd->request) + (scsi_bufflen(scmd) / 512);
1638        u64 factor = scmd->device->sector_size / 512;
1639        u64 bad_lba;
1640        int info_valid;
1641        /*
1642         * resid is optional but mostly filled in.  When it's unused,
1643         * its value is zero, so we assume the whole buffer transferred
1644         */
1645        unsigned int transferred = scsi_bufflen(scmd) - scsi_get_resid(scmd);
1646        unsigned int good_bytes;
1647
1648        if (scmd->request->cmd_type != REQ_TYPE_FS)
1649                return 0;
1650
1651        info_valid = scsi_get_sense_info_fld(scmd->sense_buffer,
1652                                             SCSI_SENSE_BUFFERSIZE,
1653                                             &bad_lba);
1654        if (!info_valid)
1655                return 0;
1656
1657        if (scsi_bufflen(scmd) <= scmd->device->sector_size)
1658                return 0;
1659
1660        /* be careful ... don't want any overflows */
1661        do_div(start_lba, factor);
1662        do_div(end_lba, factor);
1663
1664        /* The bad lba was reported incorrectly, we have no idea where
1665         * the error is.
1666         */
1667        if (bad_lba < start_lba  || bad_lba >= end_lba)
1668                return 0;
1669
1670        /* This computation should always be done in terms of
1671         * the resolution of the device's medium.
1672         */
1673        good_bytes = (bad_lba - start_lba) * scmd->device->sector_size;
1674        return min(good_bytes, transferred);
1675}
1676
1677/**
1678 *      sd_done - bottom half handler: called when the lower level
1679 *      driver has completed (successfully or otherwise) a scsi command.
1680 *      @SCpnt: mid-level's per command structure.
1681 *
1682 *      Note: potentially run from within an ISR. Must not block.
1683 **/
1684static int sd_done(struct scsi_cmnd *SCpnt)
1685{
1686        int result = SCpnt->result;
1687        unsigned int good_bytes = result ? 0 : scsi_bufflen(SCpnt);
1688        struct scsi_sense_hdr sshdr;
1689        struct scsi_disk *sdkp = scsi_disk(SCpnt->request->rq_disk);
1690        struct request *req = SCpnt->request;
1691        int sense_valid = 0;
1692        int sense_deferred = 0;
1693        unsigned char op = SCpnt->cmnd[0];
1694        unsigned char unmap = SCpnt->cmnd[1] & 8;
1695
1696        if (req->cmd_flags & REQ_DISCARD || req->cmd_flags & REQ_WRITE_SAME) {
1697                if (!result) {
1698                        good_bytes = blk_rq_bytes(req);
1699                        scsi_set_resid(SCpnt, 0);
1700                } else {
1701                        good_bytes = 0;
1702                        scsi_set_resid(SCpnt, blk_rq_bytes(req));
1703                }
1704        }
1705
1706        if (result) {
1707                sense_valid = scsi_command_normalize_sense(SCpnt, &sshdr);
1708                if (sense_valid)
1709                        sense_deferred = scsi_sense_is_deferred(&sshdr);
1710        }
1711#ifdef CONFIG_SCSI_LOGGING
1712        SCSI_LOG_HLCOMPLETE(1, scsi_print_result(SCpnt));
1713        if (sense_valid) {
1714                SCSI_LOG_HLCOMPLETE(1, scmd_printk(KERN_INFO, SCpnt,
1715                                                   "sd_done: sb[respc,sk,asc,"
1716                                                   "ascq]=%x,%x,%x,%x\n",
1717                                                   sshdr.response_code,
1718                                                   sshdr.sense_key, sshdr.asc,
1719                                                   sshdr.ascq));
1720        }
1721#endif
1722        sdkp->medium_access_timed_out = 0;
1723
1724        if (driver_byte(result) != DRIVER_SENSE &&
1725            (!sense_valid || sense_deferred))
1726                goto out;
1727
1728        switch (sshdr.sense_key) {
1729        case HARDWARE_ERROR:
1730        case MEDIUM_ERROR:
1731                good_bytes = sd_completed_bytes(SCpnt);
1732                break;
1733        case RECOVERED_ERROR:
1734                good_bytes = scsi_bufflen(SCpnt);
1735                break;
1736        case NO_SENSE:
1737                /* This indicates a false check condition, so ignore it.  An
1738                 * unknown amount of data was transferred so treat it as an
1739                 * error.
1740                 */
1741                scsi_print_sense("sd", SCpnt);
1742                SCpnt->result = 0;
1743                memset(SCpnt->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
1744                break;
1745        case ABORTED_COMMAND:
1746                if (sshdr.asc == 0x10)  /* DIF: Target detected corruption */
1747                        good_bytes = sd_completed_bytes(SCpnt);
1748                break;
1749        case ILLEGAL_REQUEST:
1750                if (sshdr.asc == 0x10)  /* DIX: Host detected corruption */
1751                        good_bytes = sd_completed_bytes(SCpnt);
1752                /* INVALID COMMAND OPCODE or INVALID FIELD IN CDB */
1753                if (sshdr.asc == 0x20 || sshdr.asc == 0x24) {
1754                        switch (op) {
1755                        case UNMAP:
1756                                sd_config_discard(sdkp, SD_LBP_DISABLE);
1757                                break;
1758                        case WRITE_SAME_16:
1759                        case WRITE_SAME:
1760                                if (unmap)
1761                                        sd_config_discard(sdkp, SD_LBP_DISABLE);
1762                                else {
1763                                        sdkp->device->no_write_same = 1;
1764                                        sd_config_write_same(sdkp);
1765
1766                                        good_bytes = 0;
1767                                        req->__data_len = blk_rq_bytes(req);
1768                                        req->cmd_flags |= REQ_QUIET;
1769                                }
1770                        }
1771                }
1772                break;
1773        default:
1774                break;
1775        }
1776 out:
1777        if (rq_data_dir(SCpnt->request) == READ && scsi_prot_sg_count(SCpnt))
1778                sd_dif_complete(SCpnt, good_bytes);
1779
1780        return good_bytes;
1781}
1782
1783/*
1784 * spinup disk - called only in sd_revalidate_disk()
1785 */
1786static void
1787sd_spinup_disk(struct scsi_disk *sdkp)
1788{
1789        unsigned char cmd[10];
1790        unsigned long spintime_expire = 0;
1791        int retries, spintime;
1792        unsigned int the_result;
1793        struct scsi_sense_hdr sshdr;
1794        int sense_valid = 0;
1795
1796        spintime = 0;
1797
1798        /* Spin up drives, as required.  Only do this at boot time */
1799        /* Spinup needs to be done for module loads too. */
1800        do {
1801                retries = 0;
1802
1803                do {
1804                        cmd[0] = TEST_UNIT_READY;
1805                        memset((void *) &cmd[1], 0, 9);
1806
1807                        the_result = scsi_execute_req(sdkp->device, cmd,
1808                                                      DMA_NONE, NULL, 0,
1809                                                      &sshdr, SD_TIMEOUT,
1810                                                      SD_MAX_RETRIES, NULL);
1811
1812                        /*
1813                         * If the drive has indicated to us that it
1814                         * doesn't have any media in it, don't bother
1815                         * with any more polling.
1816                         */
1817                        if (media_not_present(sdkp, &sshdr))
1818                                return;
1819
1820                        if (the_result)
1821                                sense_valid = scsi_sense_valid(&sshdr);
1822                        retries++;
1823                } while (retries < 3 &&
1824                         (!scsi_status_is_good(the_result) ||
1825                          ((driver_byte(the_result) & DRIVER_SENSE) &&
1826                          sense_valid && sshdr.sense_key == UNIT_ATTENTION)));
1827
1828                if ((driver_byte(the_result) & DRIVER_SENSE) == 0) {
1829                        /* no sense, TUR either succeeded or failed
1830                         * with a status error */
1831                        if(!spintime && !scsi_status_is_good(the_result)) {
1832                                sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready\n");
1833                                sd_print_result(sdkp, the_result);
1834                        }
1835                        break;
1836                }
1837                                       
1838                /*
1839                 * The device does not want the automatic start to be issued.
1840                 */
1841                if (sdkp->device->no_start_on_add)
1842                        break;
1843
1844                if (sense_valid && sshdr.sense_key == NOT_READY) {
1845                        if (sshdr.asc == 4 && sshdr.ascq == 3)
1846                                break;  /* manual intervention required */
1847                        if (sshdr.asc == 4 && sshdr.ascq == 0xb)
1848                                break;  /* standby */
1849                        if (sshdr.asc == 4 && sshdr.ascq == 0xc)
1850                                break;  /* unavailable */
1851                        /*
1852                         * Issue command to spin up drive when not ready
1853                         */
1854                        if (!spintime) {
1855                                sd_printk(KERN_NOTICE, sdkp, "Spinning up disk...");
1856                                cmd[0] = START_STOP;
1857                                cmd[1] = 1;     /* Return immediately */
1858                                memset((void *) &cmd[2], 0, 8);
1859                                cmd[4] = 1;     /* Start spin cycle */
1860                                if (sdkp->device->start_stop_pwr_cond)
1861                                        cmd[4] |= 1 << 4;
1862                                scsi_execute_req(sdkp->device, cmd, DMA_NONE,
1863                                                 NULL, 0, &sshdr,
1864                                                 SD_TIMEOUT, SD_MAX_RETRIES,
1865                                                 NULL);
1866                                spintime_expire = jiffies + 100 * HZ;
1867                                spintime = 1;
1868                        }
1869                        /* Wait 1 second for next try */
1870                        msleep(1000);
1871                        printk(".");
1872
1873                /*
1874                 * Wait for USB flash devices with slow firmware.
1875                 * Yes, this sense key/ASC combination shouldn't
1876                 * occur here.  It's characteristic of these devices.
1877                 */
1878                } else if (sense_valid &&
1879                                sshdr.sense_key == UNIT_ATTENTION &&
1880                                sshdr.asc == 0x28) {
1881                        if (!spintime) {
1882                                spintime_expire = jiffies + 5 * HZ;
1883                                spintime = 1;
1884                        }
1885                        /* Wait 1 second for next try */
1886                        msleep(1000);
1887                } else {
1888                        /* we don't understand the sense code, so it's
1889                         * probably pointless to loop */
1890                        if(!spintime) {
1891                                sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready\n");
1892                                sd_print_sense_hdr(sdkp, &sshdr);
1893                        }
1894                        break;
1895                }
1896                               
1897        } while (spintime && time_before_eq(jiffies, spintime_expire));
1898
1899        if (spintime) {
1900                if (scsi_status_is_good(the_result))
1901                        printk("ready\n");
1902                else
1903                        printk("not responding...\n");
1904        }
1905}
1906
1907
1908/*
1909 * Determine whether disk supports Data Integrity Field.
1910 */
1911static int sd_read_protection_type(struct scsi_disk *sdkp, unsigned char *buffer)
1912{
1913        struct scsi_device *sdp = sdkp->device;
1914        u8 type;
1915        int ret = 0;
1916
1917        if (scsi_device_protection(sdp) == 0 || (buffer[12] & 1) == 0)
1918                return ret;
1919
1920        type = ((buffer[12] >> 1) & 7) + 1; /* P_TYPE 0 = Type 1 */
1921
1922        if (type > SD_DIF_TYPE3_PROTECTION)
1923                ret = -ENODEV;
1924        else if (scsi_host_dif_capable(sdp->host, type))
1925                ret = 1;
1926
1927        if (sdkp->first_scan || type != sdkp->protection_type)
1928                switch (ret) {
1929                case -ENODEV:
1930                        sd_printk(KERN_ERR, sdkp, "formatted with unsupported" \
1931                                  " protection type %u. Disabling disk!\n",
1932                                  type);
1933                        break;
1934                case 1:
1935                        sd_printk(KERN_NOTICE, sdkp,
1936                                  "Enabling DIF Type %u protection\n", type);
1937                        break;
1938                case 0:
1939                        sd_printk(KERN_NOTICE, sdkp,
1940                                  "Disabling DIF Type %u protection\n", type);
1941                        break;
1942                }
1943
1944        sdkp->protection_type = type;
1945
1946        return ret;
1947}
1948
1949static void read_capacity_error(struct scsi_disk *sdkp, struct scsi_device *sdp,
1950                        struct scsi_sense_hdr *sshdr, int sense_valid,
1951                        int the_result)
1952{
1953        sd_print_result(sdkp, the_result);
1954        if (driver_byte(the_result) & DRIVER_SENSE)
1955                sd_print_sense_hdr(sdkp, sshdr);
1956        else
1957                sd_printk(KERN_NOTICE, sdkp, "Sense not available.\n");
1958
1959        /*
1960         * Set dirty bit for removable devices if not ready -
1961         * sometimes drives will not report this properly.
1962         */
1963        if (sdp->removable &&
1964            sense_valid && sshdr->sense_key == NOT_READY)
1965                set_media_not_present(sdkp);
1966
1967        /*
1968         * We used to set media_present to 0 here to indicate no media
1969         * in the drive, but some drives fail read capacity even with
1970         * media present, so we can't do that.
1971         */
1972        sdkp->capacity = 0; /* unknown mapped to zero - as usual */
1973}
1974
1975#define RC16_LEN 32
1976#if RC16_LEN > SD_BUF_SIZE
1977#error RC16_LEN must not be more than SD_BUF_SIZE
1978#endif
1979
1980#define READ_CAPACITY_RETRIES_ON_RESET  10
1981
1982/*
1983 * Ensure that we don't overflow sector_t when CONFIG_LBDAF is not set
1984 * and the reported logical block size is bigger than 512 bytes. Note
1985 * that last_sector is a u64 and therefore logical_to_sectors() is not
1986 * applicable.
1987 */
1988static bool sd_addressable_capacity(u64 lba, unsigned int sector_size)
1989{
1990        u64 last_sector = (lba + 1ULL) << (ilog2(sector_size) - 9);
1991
1992        if (sizeof(sector_t) == 4 && last_sector > U32_MAX)
1993                return false;
1994
1995        return true;
1996}
1997
1998static int read_capacity_16(struct scsi_disk *sdkp, struct scsi_device *sdp,
1999                                                unsigned char *buffer)
2000{
2001        unsigned char cmd[16];
2002        struct scsi_sense_hdr sshdr;
2003        int sense_valid = 0;
2004        int the_result;
2005        int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
2006        unsigned int alignment;
2007        unsigned long long lba;
2008        unsigned sector_size;
2009
2010        if (sdp->no_read_capacity_16)
2011                return -EINVAL;
2012
2013        do {
2014                memset(cmd, 0, 16);
2015                cmd[0] = SERVICE_ACTION_IN;
2016                cmd[1] = SAI_READ_CAPACITY_16;
2017                cmd[13] = RC16_LEN;
2018                memset(buffer, 0, RC16_LEN);
2019
2020                the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
2021                                        buffer, RC16_LEN, &sshdr,
2022                                        SD_TIMEOUT, SD_MAX_RETRIES, NULL);
2023
2024                if (media_not_present(sdkp, &sshdr))
2025                        return -ENODEV;
2026
2027                if (the_result) {
2028                        sense_valid = scsi_sense_valid(&sshdr);
2029                        if (sense_valid &&
2030                            sshdr.sense_key == ILLEGAL_REQUEST &&
2031                            (sshdr.asc == 0x20 || sshdr.asc == 0x24) &&
2032                            sshdr.ascq == 0x00)
2033                                /* Invalid Command Operation Code or
2034                                 * Invalid Field in CDB, just retry
2035                                 * silently with RC10 */
2036                                return -EINVAL;
2037                        if (sense_valid &&
2038                            sshdr.sense_key == UNIT_ATTENTION &&
2039                            sshdr.asc == 0x29 && sshdr.ascq == 0x00)
2040                                /* Device reset might occur several times,
2041                                 * give it one more chance */
2042                                if (--reset_retries > 0)
2043                                        continue;
2044                }
2045                retries--;
2046
2047        } while (the_result && retries);
2048
2049        if (the_result) {
2050                sd_printk(KERN_NOTICE, sdkp, "READ CAPACITY(16) failed\n");
2051                read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
2052                return -EINVAL;
2053        }
2054
2055        sector_size = get_unaligned_be32(&buffer[8]);
2056        lba = get_unaligned_be64(&buffer[0]);
2057
2058        if (sd_read_protection_type(sdkp, buffer) < 0) {
2059                sdkp->capacity = 0;
2060                return -ENODEV;
2061        }
2062
2063        if (!sd_addressable_capacity(lba, sector_size)) {
2064                sd_printk(KERN_ERR, sdkp, "Too big for this kernel. Use a "
2065                        "kernel compiled with support for large block "
2066                        "devices.\n");
2067                sdkp->capacity = 0;
2068                return -EOVERFLOW;
2069        }
2070
2071        /* Logical blocks per physical block exponent */
2072        sdkp->physical_block_size = (1 << (buffer[13] & 0xf)) * sector_size;
2073
2074        /* Lowest aligned logical block */
2075        alignment = ((buffer[14] & 0x3f) << 8 | buffer[15]) * sector_size;
2076        blk_queue_alignment_offset(sdp->request_queue, alignment);
2077        if (alignment && sdkp->first_scan)
2078                sd_printk(KERN_NOTICE, sdkp,
2079                          "physical block alignment offset: %u\n", alignment);
2080
2081        if (buffer[14] & 0x80) { /* LBPME */
2082                sdkp->lbpme = 1;
2083
2084                if (buffer[14] & 0x40) /* LBPRZ */
2085                        sdkp->lbprz = 1;
2086
2087                sd_config_discard(sdkp, SD_LBP_WS16);
2088        }
2089
2090        sdkp->capacity = lba + 1;
2091        return sector_size;
2092}
2093
2094static int read_capacity_10(struct scsi_disk *sdkp, struct scsi_device *sdp,
2095                                                unsigned char *buffer)
2096{
2097        unsigned char cmd[16];
2098        struct scsi_sense_hdr sshdr;
2099        int sense_valid = 0;
2100        int the_result;
2101        int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
2102        sector_t lba;
2103        unsigned sector_size;
2104
2105        do {
2106                cmd[0] = READ_CAPACITY;
2107                memset(&cmd[1], 0, 9);
2108                memset(buffer, 0, 8);
2109
2110                the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
2111                                        buffer, 8, &sshdr,
2112                                        SD_TIMEOUT, SD_MAX_RETRIES, NULL);
2113
2114                if (media_not_present(sdkp, &sshdr))
2115                        return -ENODEV;
2116
2117                if (the_result) {
2118                        sense_valid = scsi_sense_valid(&sshdr);
2119                        if (sense_valid &&
2120                            sshdr.sense_key == UNIT_ATTENTION &&
2121                            sshdr.asc == 0x29 && sshdr.ascq == 0x00)
2122                                /* Device reset might occur several times,
2123                                 * give it one more chance */
2124                                if (--reset_retries > 0)
2125                                        continue;
2126                }
2127                retries--;
2128
2129        } while (the_result && retries);
2130
2131        if (the_result) {
2132                sd_printk(KERN_NOTICE, sdkp, "READ CAPACITY failed\n");
2133                read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
2134                return -EINVAL;
2135        }
2136
2137        sector_size = get_unaligned_be32(&buffer[4]);
2138        lba = get_unaligned_be32(&buffer[0]);
2139
2140        if (sdp->no_read_capacity_16 && (lba == 0xffffffff)) {
2141                /* Some buggy (usb cardreader) devices return an lba of
2142                   0xffffffff when the want to report a size of 0 (with
2143                   which they really mean no media is present) */
2144                sdkp->capacity = 0;
2145                sdkp->physical_block_size = sector_size;
2146                return sector_size;
2147        }
2148
2149        if (!sd_addressable_capacity(lba, sector_size)) {
2150                sd_printk(KERN_ERR, sdkp, "Too big for this kernel. Use a "
2151                        "kernel compiled with support for large block "
2152                        "devices.\n");
2153                sdkp->capacity = 0;
2154                return -EOVERFLOW;
2155        }
2156
2157        sdkp->capacity = lba + 1;
2158        sdkp->physical_block_size = sector_size;
2159        return sector_size;
2160}
2161
2162static int sd_try_rc16_first(struct scsi_device *sdp)
2163{
2164        if (sdp->host->max_cmd_len < 16)
2165                return 0;
2166        if (sdp->try_rc_10_first)
2167                return 0;
2168        if (sdp->scsi_level > SCSI_SPC_2)
2169                return 1;
2170        if (scsi_device_protection(sdp))
2171                return 1;
2172        return 0;
2173}
2174
2175/*
2176 * read disk capacity
2177 */
2178static void
2179sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer)
2180{
2181        int sector_size;
2182        struct scsi_device *sdp = sdkp->device;
2183        sector_t old_capacity = sdkp->capacity;
2184
2185        if (sd_try_rc16_first(sdp)) {
2186                sector_size = read_capacity_16(sdkp, sdp, buffer);
2187                if (sector_size == -EOVERFLOW)
2188                        goto got_data;
2189                if (sector_size == -ENODEV)
2190                        return;
2191                if (sector_size < 0)
2192                        sector_size = read_capacity_10(sdkp, sdp, buffer);
2193                if (sector_size < 0)
2194                        return;
2195        } else {
2196                sector_size = read_capacity_10(sdkp, sdp, buffer);
2197                if (sector_size == -EOVERFLOW)
2198                        goto got_data;
2199                if (sector_size < 0)
2200                        return;
2201                if ((sizeof(sdkp->capacity) > 4) &&
2202                    (sdkp->capacity > 0xffffffffULL)) {
2203                        int old_sector_size = sector_size;
2204                        sd_printk(KERN_NOTICE, sdkp, "Very big device. "
2205                                        "Trying to use READ CAPACITY(16).\n");
2206                        sector_size = read_capacity_16(sdkp, sdp, buffer);
2207                        if (sector_size < 0) {
2208                                sd_printk(KERN_NOTICE, sdkp,
2209                                        "Using 0xffffffff as device size\n");
2210                                sdkp->capacity = 1 + (sector_t) 0xffffffff;
2211                                sector_size = old_sector_size;
2212                                goto got_data;
2213                        }
2214                }
2215        }
2216
2217        /* Some devices are known to return the total number of blocks,
2218         * not the highest block number.  Some devices have versions
2219         * which do this and others which do not.  Some devices we might
2220         * suspect of doing this but we don't know for certain.
2221         *
2222         * If we know the reported capacity is wrong, decrement it.  If
2223         * we can only guess, then assume the number of blocks is even
2224         * (usually true but not always) and err on the side of lowering
2225         * the capacity.
2226         */
2227        if (sdp->fix_capacity ||
2228            (sdp->guess_capacity && (sdkp->capacity & 0x01))) {
2229                sd_printk(KERN_INFO, sdkp, "Adjusting the sector count "
2230                                "from its reported value: %llu\n",
2231                                (unsigned long long) sdkp->capacity);
2232                --sdkp->capacity;
2233        }
2234
2235got_data:
2236        if (sector_size == 0) {
2237                sector_size = 512;
2238                sd_printk(KERN_NOTICE, sdkp, "Sector size 0 reported, "
2239                          "assuming 512.\n");
2240        }
2241
2242        if (sector_size != 512 &&
2243            sector_size != 1024 &&
2244            sector_size != 2048 &&
2245            sector_size != 4096) {
2246                sd_printk(KERN_NOTICE, sdkp, "Unsupported sector size %d.\n",
2247                          sector_size);
2248                /*
2249                 * The user might want to re-format the drive with
2250                 * a supported sectorsize.  Once this happens, it
2251                 * would be relatively trivial to set the thing up.
2252                 * For this reason, we leave the thing in the table.
2253                 */
2254                sdkp->capacity = 0;
2255                /*
2256                 * set a bogus sector size so the normal read/write
2257                 * logic in the block layer will eventually refuse any
2258                 * request on this device without tripping over power
2259                 * of two sector size assumptions
2260                 */
2261                sector_size = 512;
2262        }
2263        blk_queue_logical_block_size(sdp->request_queue, sector_size);
2264
2265        {
2266                char cap_str_2[10], cap_str_10[10];
2267                u64 sz = (u64)sdkp->capacity << ilog2(sector_size);
2268
2269                string_get_size(sz, STRING_UNITS_2, cap_str_2,
2270                                sizeof(cap_str_2));
2271                string_get_size(sz, STRING_UNITS_10, cap_str_10,
2272                                sizeof(cap_str_10));
2273
2274                if (sdkp->first_scan || old_capacity != sdkp->capacity) {
2275                        sd_printk(KERN_NOTICE, sdkp,
2276                                  "%llu %d-byte logical blocks: (%s/%s)\n",
2277                                  (unsigned long long)sdkp->capacity,
2278                                  sector_size, cap_str_10, cap_str_2);
2279
2280                        if (sdkp->physical_block_size != sector_size)
2281                                sd_printk(KERN_NOTICE, sdkp,
2282                                          "%u-byte physical blocks\n",
2283                                          sdkp->physical_block_size);
2284                }
2285        }
2286
2287        if (sdkp->capacity > 0xffffffff) {
2288                sdp->use_16_for_rw = 1;
2289                sdkp->max_xfer_blocks = SD_MAX_XFER_BLOCKS;
2290        } else
2291                sdkp->max_xfer_blocks = SD_DEF_XFER_BLOCKS;
2292
2293        blk_queue_physical_block_size(sdp->request_queue,
2294                                      sdkp->physical_block_size);
2295        sdkp->device->sector_size = sector_size;
2296}
2297
2298/* called with buffer of length 512 */
2299static inline int
2300sd_do_mode_sense(struct scsi_device *sdp, int dbd, int modepage,
2301                 unsigned char *buffer, int len, struct scsi_mode_data *data,
2302                 struct scsi_sense_hdr *sshdr)
2303{
2304        return scsi_mode_sense(sdp, dbd, modepage, buffer, len,
2305                               SD_TIMEOUT, SD_MAX_RETRIES, data,
2306                               sshdr);
2307}
2308
2309/*
2310 * read write protect setting, if possible - called only in sd_revalidate_disk()
2311 * called with buffer of length SD_BUF_SIZE
2312 */
2313static void
2314sd_read_write_protect_flag(struct scsi_disk *sdkp, unsigned char *buffer)
2315{
2316        int res;
2317        struct scsi_device *sdp = sdkp->device;
2318        struct scsi_mode_data data;
2319        int old_wp = sdkp->write_prot;
2320
2321        set_disk_ro(sdkp->disk, 0);
2322        if (sdp->skip_ms_page_3f) {
2323                sd_first_printk(KERN_NOTICE, sdkp, "Assuming Write Enabled\n");
2324                return;
2325        }
2326
2327        if (sdp->use_192_bytes_for_3f) {
2328                res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 192, &data, NULL);
2329        } else {
2330                /*
2331                 * First attempt: ask for all pages (0x3F), but only 4 bytes.
2332                 * We have to start carefully: some devices hang if we ask
2333                 * for more than is available.
2334                 */
2335                res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 4, &data, NULL);
2336
2337                /*
2338                 * Second attempt: ask for page 0 When only page 0 is
2339                 * implemented, a request for page 3F may return Sense Key
2340                 * 5: Illegal Request, Sense Code 24: Invalid field in
2341                 * CDB.
2342                 */
2343                if (!scsi_status_is_good(res))
2344                        res = sd_do_mode_sense(sdp, 0, 0, buffer, 4, &data, NULL);
2345
2346                /*
2347                 * Third attempt: ask 255 bytes, as we did earlier.
2348                 */
2349                if (!scsi_status_is_good(res))
2350                        res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 255,
2351                                               &data, NULL);
2352        }
2353
2354        if (!scsi_status_is_good(res)) {
2355                sd_first_printk(KERN_WARNING, sdkp,
2356                          "Test WP failed, assume Write Enabled\n");
2357        } else {
2358                sdkp->write_prot = ((data.device_specific & 0x80) != 0);
2359                set_disk_ro(sdkp->disk, sdkp->write_prot);
2360                if (sdkp->first_scan || old_wp != sdkp->write_prot) {
2361                        sd_printk(KERN_NOTICE, sdkp, "Write Protect is %s\n",
2362                                  sdkp->write_prot ? "on" : "off");
2363                        sd_printk(KERN_DEBUG, sdkp,
2364                                  "Mode Sense: %02x %02x %02x %02x\n",
2365                                  buffer[0], buffer[1], buffer[2], buffer[3]);
2366                }
2367        }
2368}
2369
2370/*
2371 * sd_read_cache_type - called only from sd_revalidate_disk()
2372 * called with buffer of length SD_BUF_SIZE
2373 */
2374static void
2375sd_read_cache_type(struct scsi_disk *sdkp, unsigned char *buffer)
2376{
2377        int len = 0, res;
2378        struct scsi_device *sdp = sdkp->device;
2379
2380        int dbd;
2381        int modepage;
2382        int first_len;
2383        struct scsi_mode_data data;
2384        struct scsi_sense_hdr sshdr;
2385        int old_wce = sdkp->WCE;
2386        int old_rcd = sdkp->RCD;
2387        int old_dpofua = sdkp->DPOFUA;
2388
2389
2390        if (sdkp->cache_override)
2391                return;
2392
2393        first_len = 4;
2394        if (sdp->skip_ms_page_8) {
2395                if (sdp->type == TYPE_RBC)
2396                        goto defaults;
2397                else {
2398                        if (sdp->skip_ms_page_3f)
2399                                goto defaults;
2400                        modepage = 0x3F;
2401                        if (sdp->use_192_bytes_for_3f)
2402                                first_len = 192;
2403                        dbd = 0;
2404                }
2405        } else if (sdp->type == TYPE_RBC) {
2406                modepage = 6;
2407                dbd = 8;
2408        } else {
2409                modepage = 8;
2410                dbd = 0;
2411        }
2412
2413        /* cautiously ask */
2414        res = sd_do_mode_sense(sdp, dbd, modepage, buffer, first_len,
2415                        &data, &sshdr);
2416
2417        if (!scsi_status_is_good(res))
2418                goto bad_sense;
2419
2420        if (!data.header_length) {
2421                modepage = 6;
2422                first_len = 0;
2423                sd_first_printk(KERN_ERR, sdkp,
2424                                "Missing header in MODE_SENSE response\n");
2425        }
2426
2427        /* that went OK, now ask for the proper length */
2428        len = data.length;
2429
2430        /*
2431         * We're only interested in the first three bytes, actually.
2432         * But the data cache page is defined for the first 20.
2433         */
2434        if (len < 3)
2435                goto bad_sense;
2436        else if (len > SD_BUF_SIZE) {
2437                sd_first_printk(KERN_NOTICE, sdkp, "Truncating mode parameter "
2438                          "data from %d to %d bytes\n", len, SD_BUF_SIZE);
2439                len = SD_BUF_SIZE;
2440        }
2441        if (modepage == 0x3F && sdp->use_192_bytes_for_3f)
2442                len = 192;
2443
2444        /* Get the data */
2445        if (len > first_len)
2446                res = sd_do_mode_sense(sdp, dbd, modepage, buffer, len,
2447                                &data, &sshdr);
2448
2449        if (scsi_status_is_good(res)) {
2450                int offset = data.header_length + data.block_descriptor_length;
2451
2452                while (offset < len) {
2453                        u8 page_code = buffer[offset] & 0x3F;
2454                        u8 spf       = buffer[offset] & 0x40;
2455
2456                        if (page_code == 8 || page_code == 6) {
2457                                /* We're interested only in the first 3 bytes.
2458                                 */
2459                                if (len - offset <= 2) {
2460                                        sd_first_printk(KERN_ERR, sdkp,
2461                                                "Incomplete mode parameter "
2462                                                        "data\n");
2463                                        goto defaults;
2464                                } else {
2465                                        modepage = page_code;
2466                                        goto Page_found;
2467                                }
2468                        } else {
2469                                /* Go to the next page */
2470                                if (spf && len - offset > 3)
2471                                        offset += 4 + (buffer[offset+2] << 8) +
2472                                                buffer[offset+3];
2473                                else if (!spf && len - offset > 1)
2474                                        offset += 2 + buffer[offset+1];
2475                                else {
2476                                        sd_first_printk(KERN_ERR, sdkp,
2477                                                        "Incomplete mode "
2478                                                        "parameter data\n");
2479                                        goto defaults;
2480                                }
2481                        }
2482                }
2483
2484                sd_first_printk(KERN_ERR, sdkp, "No Caching mode page found\n");
2485                goto defaults;
2486
2487        Page_found:
2488                if (modepage == 8) {
2489                        sdkp->WCE = ((buffer[offset + 2] & 0x04) != 0);
2490                        sdkp->RCD = ((buffer[offset + 2] & 0x01) != 0);
2491                } else {
2492                        sdkp->WCE = ((buffer[offset + 2] & 0x01) == 0);
2493                        sdkp->RCD = 0;
2494                }
2495
2496                sdkp->DPOFUA = (data.device_specific & 0x10) != 0;
2497                if (sdp->broken_fua) {
2498                        sd_first_printk(KERN_NOTICE, sdkp, "Disabling FUA\n");
2499                        sdkp->DPOFUA = 0;
2500                } else if (sdkp->DPOFUA && !sdkp->device->use_10_for_rw) {
2501                        sd_first_printk(KERN_NOTICE, sdkp,
2502                                  "Uses READ/WRITE(6), disabling FUA\n");
2503                        sdkp->DPOFUA = 0;
2504                }
2505
2506                /* No cache flush allowed for write protected devices */
2507                if (sdkp->WCE && sdkp->write_prot)
2508                        sdkp->WCE = 0;
2509
2510                if (sdkp->first_scan || old_wce != sdkp->WCE ||
2511                    old_rcd != sdkp->RCD || old_dpofua != sdkp->DPOFUA)
2512                        sd_printk(KERN_NOTICE, sdkp,
2513                                  "Write cache: %s, read cache: %s, %s\n",
2514                                  sdkp->WCE ? "enabled" : "disabled",
2515                                  sdkp->RCD ? "disabled" : "enabled",
2516                                  sdkp->DPOFUA ? "supports DPO and FUA"
2517                                  : "doesn't support DPO or FUA");
2518
2519                return;
2520        }
2521
2522bad_sense:
2523        if (scsi_sense_valid(&sshdr) &&
2524            sshdr.sense_key == ILLEGAL_REQUEST &&
2525            sshdr.asc == 0x24 && sshdr.ascq == 0x0)
2526                /* Invalid field in CDB */
2527                sd_first_printk(KERN_NOTICE, sdkp, "Cache data unavailable\n");
2528        else
2529                sd_first_printk(KERN_ERR, sdkp,
2530                                "Asking for cache data failed\n");
2531
2532defaults:
2533        if (sdp->wce_default_on) {
2534                sd_first_printk(KERN_NOTICE, sdkp,
2535                                "Assuming drive cache: write back\n");
2536                sdkp->WCE = 1;
2537        } else {
2538                sd_first_printk(KERN_ERR, sdkp,
2539                                "Assuming drive cache: write through\n");
2540                sdkp->WCE = 0;
2541        }
2542        sdkp->RCD = 0;
2543        sdkp->DPOFUA = 0;
2544}
2545
2546/*
2547 * The ATO bit indicates whether the DIF application tag is available
2548 * for use by the operating system.
2549 */
2550static void sd_read_app_tag_own(struct scsi_disk *sdkp, unsigned char *buffer)
2551{
2552        int res, offset;
2553        struct scsi_device *sdp = sdkp->device;
2554        struct scsi_mode_data data;
2555        struct scsi_sense_hdr sshdr;
2556
2557        if (sdp->type != TYPE_DISK)
2558                return;
2559
2560        if (sdkp->protection_type == 0)
2561                return;
2562
2563        res = scsi_mode_sense(sdp, 1, 0x0a, buffer, 36, SD_TIMEOUT,
2564                              SD_MAX_RETRIES, &data, &sshdr);
2565
2566        if (!scsi_status_is_good(res) || !data.header_length ||
2567            data.length < 6) {
2568                sd_first_printk(KERN_WARNING, sdkp,
2569                          "getting Control mode page failed, assume no ATO\n");
2570
2571                if (scsi_sense_valid(&sshdr))
2572                        sd_print_sense_hdr(sdkp, &sshdr);
2573
2574                return;
2575        }
2576
2577        offset = data.header_length + data.block_descriptor_length;
2578
2579        if ((buffer[offset] & 0x3f) != 0x0a) {
2580                sd_first_printk(KERN_ERR, sdkp, "ATO Got wrong page\n");
2581                return;
2582        }
2583
2584        if ((buffer[offset + 5] & 0x80) == 0)
2585                return;
2586
2587        sdkp->ATO = 1;
2588
2589        return;
2590}
2591
2592/**
2593 * sd_read_block_limits - Query disk device for preferred I/O sizes.
2594 * @disk: disk to query
2595 */
2596static void sd_read_block_limits(struct scsi_disk *sdkp)
2597{
2598        unsigned int sector_sz = sdkp->device->sector_size;
2599        const int vpd_len = 64;
2600        u32 max_xfer_length;
2601        unsigned char *buffer = kmalloc(vpd_len, GFP_KERNEL);
2602
2603        if (!buffer ||
2604            /* Block Limits VPD */
2605            scsi_get_vpd_page(sdkp->device, 0xb0, buffer, vpd_len))
2606                goto out;
2607
2608        max_xfer_length = get_unaligned_be32(&buffer[8]);
2609        if (max_xfer_length)
2610                sdkp->max_xfer_blocks = max_xfer_length;
2611
2612        blk_queue_io_min(sdkp->disk->queue,
2613                         get_unaligned_be16(&buffer[6]) * sector_sz);
2614        blk_queue_io_opt(sdkp->disk->queue,
2615                         get_unaligned_be32(&buffer[12]) * sector_sz);
2616
2617        if (buffer[3] == 0x3c) {
2618                unsigned int lba_count, desc_count;
2619
2620                sdkp->max_ws_blocks = (u32)get_unaligned_be64(&buffer[36]);
2621
2622                if (!sdkp->lbpme)
2623                        goto out;
2624
2625                lba_count = get_unaligned_be32(&buffer[20]);
2626                desc_count = get_unaligned_be32(&buffer[24]);
2627
2628                if (lba_count && desc_count)
2629                        sdkp->max_unmap_blocks = lba_count;
2630
2631                sdkp->unmap_granularity = get_unaligned_be32(&buffer[28]);
2632
2633                if (buffer[32] & 0x80)
2634                        sdkp->unmap_alignment =
2635                                get_unaligned_be32(&buffer[32]) & ~(1 << 31);
2636
2637                if (!sdkp->lbpvpd) { /* LBP VPD page not provided */
2638
2639                        if (sdkp->max_unmap_blocks)
2640                                sd_config_discard(sdkp, SD_LBP_UNMAP);
2641                        else
2642                                sd_config_discard(sdkp, SD_LBP_WS16);
2643
2644                } else {        /* LBP VPD page tells us what to use */
2645
2646                        if (sdkp->lbpu && sdkp->max_unmap_blocks)
2647                                sd_config_discard(sdkp, SD_LBP_UNMAP);
2648                        else if (sdkp->lbpws)
2649                                sd_config_discard(sdkp, SD_LBP_WS16);
2650                        else if (sdkp->lbpws10)
2651                                sd_config_discard(sdkp, SD_LBP_WS10);
2652                        else
2653                                sd_config_discard(sdkp, SD_LBP_DISABLE);
2654                }
2655        }
2656
2657 out:
2658        kfree(buffer);
2659}
2660
2661/**
2662 * sd_read_block_characteristics - Query block dev. characteristics
2663 * @disk: disk to query
2664 */
2665static void sd_read_block_characteristics(struct scsi_disk *sdkp)
2666{
2667        unsigned char *buffer;
2668        u16 rot;
2669        const int vpd_len = 64;
2670
2671        buffer = kmalloc(vpd_len, GFP_KERNEL);
2672
2673        if (!buffer ||
2674            /* Block Device Characteristics VPD */
2675            scsi_get_vpd_page(sdkp->device, 0xb1, buffer, vpd_len))
2676                goto out;
2677
2678        rot = get_unaligned_be16(&buffer[4]);
2679
2680        if (rot == 1) {
2681                queue_flag_set_unlocked(QUEUE_FLAG_NONROT, sdkp->disk->queue);
2682                queue_flag_clear_unlocked(QUEUE_FLAG_ADD_RANDOM, sdkp->disk->queue);
2683        }
2684
2685 out:
2686        kfree(buffer);
2687}
2688
2689/**
2690 * sd_read_block_provisioning - Query provisioning VPD page
2691 * @disk: disk to query
2692 */
2693static void sd_read_block_provisioning(struct scsi_disk *sdkp)
2694{
2695        unsigned char *buffer;
2696        const int vpd_len = 8;
2697
2698        if (sdkp->lbpme == 0)
2699                return;
2700
2701        buffer = kmalloc(vpd_len, GFP_KERNEL);
2702
2703        if (!buffer || scsi_get_vpd_page(sdkp->device, 0xb2, buffer, vpd_len))
2704                goto out;
2705
2706        sdkp->lbpvpd    = 1;
2707        sdkp->lbpu      = (buffer[5] >> 7) & 1; /* UNMAP */
2708        sdkp->lbpws     = (buffer[5] >> 6) & 1; /* WRITE SAME(16) with UNMAP */
2709        sdkp->lbpws10   = (buffer[5] >> 5) & 1; /* WRITE SAME(10) with UNMAP */
2710
2711 out:
2712        kfree(buffer);
2713}
2714
2715static void sd_read_write_same(struct scsi_disk *sdkp, unsigned char *buffer)
2716{
2717        struct scsi_device *sdev = sdkp->device;
2718
2719        if (sdev->host->no_write_same) {
2720                sdev->no_write_same = 1;
2721
2722                return;
2723        }
2724
2725        if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, INQUIRY) < 0) {
2726                /* too large values might cause issues with arcmsr */
2727                int vpd_buf_len = 64;
2728
2729                sdev->no_report_opcodes = 1;
2730
2731                /* Disable WRITE SAME if REPORT SUPPORTED OPERATION
2732                 * CODES is unsupported and the device has an ATA
2733                 * Information VPD page (SAT).
2734                 */
2735                if (!scsi_get_vpd_page(sdev, 0x89, buffer, vpd_buf_len))
2736                        sdev->no_write_same = 1;
2737        }
2738
2739        if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME_16) == 1)
2740                sdkp->ws16 = 1;
2741
2742        if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME) == 1)
2743                sdkp->ws10 = 1;
2744}
2745
2746static int sd_try_extended_inquiry(struct scsi_device *sdp)
2747{
2748        /* Attempt VPD inquiry if the device blacklist explicitly calls
2749         * for it.
2750         */
2751        if (sdp->try_vpd_pages)
2752                return 1;
2753        /*
2754         * Although VPD inquiries can go to SCSI-2 type devices,
2755         * some USB ones crash on receiving them, and the pages
2756         * we currently ask for are for SPC-3 and beyond
2757         */
2758        if (sdp->scsi_level > SCSI_SPC_2 && !sdp->skip_vpd_pages)
2759                return 1;
2760        return 0;
2761}
2762
2763/**
2764 *      sd_revalidate_disk - called the first time a new disk is seen,
2765 *      performs disk spin up, read_capacity, etc.
2766 *      @disk: struct gendisk we care about
2767 **/
2768static int sd_revalidate_disk(struct gendisk *disk)
2769{
2770        struct scsi_disk *sdkp = scsi_disk(disk);
2771        struct scsi_device *sdp = sdkp->device;
2772        unsigned char *buffer;
2773        unsigned int max_xfer;
2774
2775        SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp,
2776                                      "sd_revalidate_disk\n"));
2777
2778        /*
2779         * If the device is offline, don't try and read capacity or any
2780         * of the other niceties.
2781         */
2782        if (!scsi_device_online(sdp))
2783                goto out;
2784
2785        buffer = kmalloc(SD_BUF_SIZE, GFP_KERNEL);
2786        if (!buffer) {
2787                sd_printk(KERN_WARNING, sdkp, "sd_revalidate_disk: Memory "
2788                          "allocation failure.\n");
2789                goto out;
2790        }
2791
2792        sd_spinup_disk(sdkp);
2793
2794        /*
2795         * Without media there is no reason to ask; moreover, some devices
2796         * react badly if we do.
2797         */
2798        if (sdkp->media_present) {
2799                sd_read_capacity(sdkp, buffer);
2800
2801                if (sd_try_extended_inquiry(sdp)) {
2802                        sd_read_block_provisioning(sdkp);
2803                        sd_read_block_limits(sdkp);
2804                        sd_read_block_characteristics(sdkp);
2805                }
2806
2807                sd_read_write_protect_flag(sdkp, buffer);
2808                sd_read_cache_type(sdkp, buffer);
2809                sd_read_app_tag_own(sdkp, buffer);
2810                sd_read_write_same(sdkp, buffer);
2811        }
2812
2813        sdkp->first_scan = 0;
2814
2815        /*
2816         * We now have all cache related info, determine how we deal
2817         * with flush requests.
2818         */
2819        sd_set_flush_flag(sdkp);
2820
2821        max_xfer = sdkp->max_xfer_blocks;
2822        max_xfer <<= ilog2(sdp->sector_size) - 9;
2823
2824        sdkp->disk->queue->limits.max_sectors =
2825                min_not_zero(queue_max_hw_sectors(sdkp->disk->queue), max_xfer);
2826
2827        set_capacity(disk, logical_to_sectors(sdp, sdkp->capacity));
2828        sd_config_write_same(sdkp);
2829        kfree(buffer);
2830
2831 out:
2832        return 0;
2833}
2834
2835/**
2836 *      sd_unlock_native_capacity - unlock native capacity
2837 *      @disk: struct gendisk to set capacity for
2838 *
2839 *      Block layer calls this function if it detects that partitions
2840 *      on @disk reach beyond the end of the device.  If the SCSI host
2841 *      implements ->unlock_native_capacity() method, it's invoked to
2842 *      give it a chance to adjust the device capacity.
2843 *
2844 *      CONTEXT:
2845 *      Defined by block layer.  Might sleep.
2846 */
2847static void sd_unlock_native_capacity(struct gendisk *disk)
2848{
2849        struct scsi_device *sdev = scsi_disk(disk)->device;
2850
2851        if (sdev->host->hostt->unlock_native_capacity)
2852                sdev->host->hostt->unlock_native_capacity(sdev);
2853}
2854
2855/**
2856 *      sd_format_disk_name - format disk name
2857 *      @prefix: name prefix - ie. "sd" for SCSI disks
2858 *      @index: index of the disk to format name for
2859 *      @buf: output buffer
2860 *      @buflen: length of the output buffer
2861 *
2862 *      SCSI disk names starts at sda.  The 26th device is sdz and the
2863 *      27th is sdaa.  The last one for two lettered suffix is sdzz
2864 *      which is followed by sdaaa.
2865 *
2866 *      This is basically 26 base counting with one extra 'nil' entry
2867 *      at the beginning from the second digit on and can be
2868 *      determined using similar method as 26 base conversion with the
2869 *      index shifted -1 after each digit is computed.
2870 *
2871 *      CONTEXT:
2872 *      Don't care.
2873 *
2874 *      RETURNS:
2875 *      0 on success, -errno on failure.
2876 */
2877static int sd_format_disk_name(char *prefix, int index, char *buf, int buflen)
2878{
2879        const int base = 'z' - 'a' + 1;
2880        char *begin = buf + strlen(prefix);
2881        char *end = buf + buflen;
2882        char *p;
2883        int unit;
2884
2885        p = end - 1;
2886        *p = '\0';
2887        unit = base;
2888        do {
2889                if (p == begin)
2890                        return -EINVAL;
2891                *--p = 'a' + (index % unit);
2892                index = (index / unit) - 1;
2893        } while (index >= 0);
2894
2895        memmove(begin, p, end - p);
2896        memcpy(buf, prefix, strlen(prefix));
2897
2898        return 0;
2899}
2900
2901/*
2902 * The asynchronous part of sd_probe
2903 */
2904static void sd_probe_async(void *data, async_cookie_t cookie)
2905{
2906        struct scsi_disk *sdkp = data;
2907        struct scsi_device *sdp;
2908        struct gendisk *gd;
2909        u32 index;
2910        struct device *dev;
2911
2912        sdp = sdkp->device;
2913        gd = sdkp->disk;
2914        index = sdkp->index;
2915        dev = &sdp->sdev_gendev;
2916
2917        gd->major = sd_major((index & 0xf0) >> 4);
2918        gd->first_minor = ((index & 0xf) << 4) | (index & 0xfff00);
2919        gd->minors = SD_MINORS;
2920
2921        gd->fops = &sd_fops;
2922        gd->private_data = &sdkp->driver;
2923        gd->queue = sdkp->device->request_queue;
2924
2925        /* defaults, until the device tells us otherwise */
2926        sdp->sector_size = 512;
2927        sdkp->capacity = 0;
2928        sdkp->media_present = 1;
2929        sdkp->write_prot = 0;
2930        sdkp->cache_override = 0;
2931        sdkp->WCE = 0;
2932        sdkp->RCD = 0;
2933        sdkp->ATO = 0;
2934        sdkp->first_scan = 1;
2935        sdkp->max_medium_access_timeouts = SD_MAX_MEDIUM_TIMEOUTS;
2936
2937        sd_revalidate_disk(gd);
2938
2939        gd->driverfs_dev = &sdp->sdev_gendev;
2940        gd->flags = GENHD_FL_EXT_DEVT;
2941        if (sdp->removable) {
2942                gd->flags |= GENHD_FL_REMOVABLE;
2943                gd->events |= DISK_EVENT_MEDIA_CHANGE;
2944        }
2945
2946        blk_pm_runtime_init(sdp->request_queue, dev);
2947        add_disk(gd);
2948        if (sdkp->capacity)
2949                sd_dif_config_host(sdkp);
2950
2951        sd_revalidate_disk(gd);
2952
2953        sd_printk(KERN_NOTICE, sdkp, "Attached SCSI %sdisk\n",
2954                  sdp->removable ? "removable " : "");
2955        scsi_autopm_put_device(sdp);
2956        put_device(&sdkp->dev);
2957}
2958
2959/**
2960 *      sd_probe - called during driver initialization and whenever a
2961 *      new scsi device is attached to the system. It is called once
2962 *      for each scsi device (not just disks) present.
2963 *      @dev: pointer to device object
2964 *
2965 *      Returns 0 if successful (or not interested in this scsi device
2966 *      (e.g. scanner)); 1 when there is an error.
2967 *
2968 *      Note: this function is invoked from the scsi mid-level.
2969 *      This function sets up the mapping between a given
2970 *      <host,channel,id,lun> (found in sdp) and new device name
2971 *      (e.g. /dev/sda). More precisely it is the block device major
2972 *      and minor number that is chosen here.
2973 *
2974 *      Assume sd_probe is not re-entrant (for time being)
2975 *      Also think about sd_probe() and sd_remove() running coincidentally.
2976 **/
2977static int sd_probe(struct device *dev)
2978{
2979        struct scsi_device *sdp = to_scsi_device(dev);
2980        struct scsi_disk *sdkp;
2981        struct gendisk *gd;
2982        int index;
2983        int error;
2984
2985        scsi_autopm_get_device(sdp);
2986        error = -ENODEV;
2987        if (sdp->type != TYPE_DISK && sdp->type != TYPE_MOD && sdp->type != TYPE_RBC)
2988                goto out;
2989
2990        SCSI_LOG_HLQUEUE(3, sdev_printk(KERN_INFO, sdp,
2991                                        "sd_probe\n"));
2992
2993        error = -ENOMEM;
2994        sdkp = kzalloc(sizeof(*sdkp), GFP_KERNEL);
2995        if (!sdkp)
2996                goto out;
2997
2998        gd = alloc_disk(SD_MINORS);
2999        if (!gd)
3000                goto out_free;
3001
3002        do {
3003                if (!ida_pre_get(&sd_index_ida, GFP_KERNEL))
3004                        goto out_put;
3005
3006                spin_lock(&sd_index_lock);
3007                error = ida_get_new(&sd_index_ida, &index);
3008                spin_unlock(&sd_index_lock);
3009        } while (error == -EAGAIN);
3010
3011        if (error) {
3012                sdev_printk(KERN_WARNING, sdp, "sd_probe: memory exhausted.\n");
3013                goto out_put;
3014        }
3015
3016        error = sd_format_disk_name("sd", index, gd->disk_name, DISK_NAME_LEN);
3017        if (error) {
3018                sdev_printk(KERN_WARNING, sdp, "SCSI disk (sd) name length exceeded.\n");
3019                goto out_free_index;
3020        }
3021
3022        sdkp->device = sdp;
3023        sdkp->driver = &sd_template;
3024        sdkp->disk = gd;
3025        sdkp->index = index;
3026        atomic_set(&sdkp->openers, 0);
3027        atomic_set(&sdkp->device->ioerr_cnt, 0);
3028
3029        if (!sdp->request_queue->rq_timeout) {
3030                if (sdp->type != TYPE_MOD)
3031                        blk_queue_rq_timeout(sdp->request_queue, SD_TIMEOUT);
3032                else
3033                        blk_queue_rq_timeout(sdp->request_queue,
3034                                             SD_MOD_TIMEOUT);
3035        }
3036
3037        device_initialize(&sdkp->dev);
3038        sdkp->dev.parent = dev;
3039        sdkp->dev.class = &sd_disk_class;
3040        dev_set_name(&sdkp->dev, "%s", dev_name(dev));
3041
3042        if (device_add(&sdkp->dev))
3043                goto out_free_index;
3044
3045        get_device(dev);
3046        dev_set_drvdata(dev, sdkp);
3047
3048        get_device(&sdkp->dev); /* prevent release before async_schedule */
3049        async_schedule_domain(sd_probe_async, sdkp, &scsi_sd_probe_domain);
3050
3051        return 0;
3052
3053 out_free_index:
3054        spin_lock(&sd_index_lock);
3055        ida_remove(&sd_index_ida, index);
3056        spin_unlock(&sd_index_lock);
3057 out_put:
3058        put_disk(gd);
3059 out_free:
3060        kfree(sdkp);
3061 out:
3062        scsi_autopm_put_device(sdp);
3063        return error;
3064}
3065
3066/**
3067 *      sd_remove - called whenever a scsi disk (previously recognized by
3068 *      sd_probe) is detached from the system. It is called (potentially
3069 *      multiple times) during sd module unload.
3070 *      @sdp: pointer to mid level scsi device object
3071 *
3072 *      Note: this function is invoked from the scsi mid-level.
3073 *      This function potentially frees up a device name (e.g. /dev/sdc)
3074 *      that could be re-used by a subsequent sd_probe().
3075 *      This function is not called when the built-in sd driver is "exit-ed".
3076 **/
3077static int sd_remove(struct device *dev)
3078{
3079        struct scsi_disk *sdkp;
3080        dev_t devt;
3081
3082        sdkp = dev_get_drvdata(dev);
3083        devt = disk_devt(sdkp->disk);
3084        scsi_autopm_get_device(sdkp->device);
3085
3086        async_synchronize_full_domain(&scsi_sd_pm_domain);
3087        async_synchronize_full_domain(&scsi_sd_probe_domain);
3088        device_del(&sdkp->dev);
3089        del_gendisk(sdkp->disk);
3090        sd_shutdown(dev);
3091
3092        blk_register_region(devt, SD_MINORS, NULL,
3093                            sd_default_probe, NULL, NULL);
3094
3095        mutex_lock(&sd_ref_mutex);
3096        dev_set_drvdata(dev, NULL);
3097        put_device(&sdkp->dev);
3098        mutex_unlock(&sd_ref_mutex);
3099
3100        return 0;
3101}
3102
3103/**
3104 *      scsi_disk_release - Called to free the scsi_disk structure
3105 *      @dev: pointer to embedded class device
3106 *
3107 *      sd_ref_mutex must be held entering this routine.  Because it is
3108 *      called on last put, you should always use the scsi_disk_get()
3109 *      scsi_disk_put() helpers which manipulate the semaphore directly
3110 *      and never do a direct put_device.
3111 **/
3112static void scsi_disk_release(struct device *dev)
3113{
3114        struct scsi_disk *sdkp = to_scsi_disk(dev);
3115        struct gendisk *disk = sdkp->disk;
3116       
3117        spin_lock(&sd_index_lock);
3118        ida_remove(&sd_index_ida, sdkp->index);
3119        spin_unlock(&sd_index_lock);
3120
3121        blk_integrity_unregister(disk);
3122        disk->private_data = NULL;
3123        put_disk(disk);
3124        put_device(&sdkp->device->sdev_gendev);
3125
3126        kfree(sdkp);
3127}
3128
3129static int sd_start_stop_device(struct scsi_disk *sdkp, int start)
3130{
3131        unsigned char cmd[6] = { START_STOP };  /* START_VALID */
3132        struct scsi_sense_hdr sshdr;
3133        struct scsi_device *sdp = sdkp->device;
3134        int res;
3135
3136        if (start)
3137                cmd[4] |= 1;    /* START */
3138
3139        if (sdp->start_stop_pwr_cond)
3140                cmd[4] |= start ? 1 << 4 : 3 << 4;      /* Active or Standby */
3141
3142        if (!scsi_device_online(sdp))
3143                return -ENODEV;
3144
3145        res = scsi_execute_req_flags(sdp, cmd, DMA_NONE, NULL, 0, &sshdr,
3146                               SD_TIMEOUT, SD_MAX_RETRIES, NULL, REQ_PM);
3147        if (res) {
3148                sd_printk(KERN_WARNING, sdkp, "START_STOP FAILED\n");
3149                sd_print_result(sdkp, res);
3150                if (driver_byte(res) & DRIVER_SENSE)
3151                        sd_print_sense_hdr(sdkp, &sshdr);
3152                if (scsi_sense_valid(&sshdr) &&
3153                        /* 0x3a is medium not present */
3154                        sshdr.asc == 0x3a)
3155                        res = 0;
3156        }
3157
3158        /* SCSI error codes must not go to the generic layer */
3159        if (res)
3160                return -EIO;
3161
3162        return 0;
3163}
3164
3165/*
3166 * Send a SYNCHRONIZE CACHE instruction down to the device through
3167 * the normal SCSI command structure.  Wait for the command to
3168 * complete.
3169 */
3170static void sd_shutdown(struct device *dev)
3171{
3172        struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
3173
3174        if (!sdkp)
3175                return;         /* this can happen */
3176
3177        if (pm_runtime_suspended(dev))
3178                goto exit;
3179
3180        if (sdkp->WCE && sdkp->media_present) {
3181                sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
3182                sd_sync_cache(sdkp);
3183        }
3184
3185        if (system_state != SYSTEM_RESTART && sdkp->device->manage_start_stop) {
3186                sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
3187                sd_start_stop_device(sdkp, 0);
3188        }
3189
3190exit:
3191        scsi_disk_put(sdkp);
3192}
3193
3194static int sd_suspend_common(struct device *dev, bool ignore_stop_errors)
3195{
3196        struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
3197        int ret = 0;
3198
3199        if (!sdkp)      /* E.g.: runtime suspend following sd_remove() */
3200                return 0;
3201
3202        if (sdkp->WCE && sdkp->media_present) {
3203                sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
3204                ret = sd_sync_cache(sdkp);
3205                if (ret) {
3206                        /* ignore OFFLINE device */
3207                        if (ret == -ENODEV)
3208                                ret = 0;
3209                        goto done;
3210                }
3211        }
3212
3213        if (sdkp->device->manage_start_stop) {
3214                sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
3215                /* an error is not worth aborting a system sleep */
3216                ret = sd_start_stop_device(sdkp, 0);
3217                if (ignore_stop_errors)
3218                        ret = 0;
3219        }
3220
3221done:
3222        scsi_disk_put(sdkp);
3223        return ret;
3224}
3225
3226static int sd_suspend_system(struct device *dev)
3227{
3228        return sd_suspend_common(dev, true);
3229}
3230
3231static int sd_suspend_runtime(struct device *dev)
3232{
3233        return sd_suspend_common(dev, false);
3234}
3235
3236static int sd_resume(struct device *dev)
3237{
3238        struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
3239        int ret = 0;
3240
3241        if (!sdkp)      /* E.g.: runtime resume at the start of sd_probe() */
3242                return 0;
3243
3244        if (!sdkp->device->manage_start_stop)
3245                goto done;
3246
3247        sd_printk(KERN_NOTICE, sdkp, "Starting disk\n");
3248        ret = sd_start_stop_device(sdkp, 1);
3249
3250done:
3251        scsi_disk_put(sdkp);
3252        return ret;
3253}
3254
3255/**
3256 *      init_sd - entry point for this driver (both when built in or when
3257 *      a module).
3258 *
3259 *      Note: this function registers this driver with the scsi mid-level.
3260 **/
3261static int __init init_sd(void)
3262{
3263        int majors = 0, i, err;
3264
3265        SCSI_LOG_HLQUEUE(3, printk("init_sd: sd driver entry point\n"));
3266
3267        for (i = 0; i < SD_MAJORS; i++) {
3268                if (register_blkdev(sd_major(i), "sd") != 0)
3269                        continue;
3270                majors++;
3271                blk_register_region(sd_major(i), SD_MINORS, NULL,
3272                                    sd_default_probe, NULL, NULL);
3273        }
3274
3275        if (!majors)
3276                return -ENODEV;
3277
3278        err = class_register(&sd_disk_class);
3279        if (err)
3280                goto err_out;
3281
3282        sd_cdb_cache = kmem_cache_create("sd_ext_cdb", SD_EXT_CDB_SIZE,
3283                                         0, 0, NULL);
3284        if (!sd_cdb_cache) {
3285                printk(KERN_ERR "sd: can't init extended cdb cache\n");
3286                err = -ENOMEM;
3287                goto err_out_class;
3288        }
3289
3290        sd_cdb_pool = mempool_create_slab_pool(SD_MEMPOOL_SIZE, sd_cdb_cache);
3291        if (!sd_cdb_pool) {
3292                printk(KERN_ERR "sd: can't init extended cdb pool\n");
3293                err = -ENOMEM;
3294                goto err_out_cache;
3295        }
3296
3297        err = scsi_register_driver(&sd_template.gendrv);
3298        if (err)
3299                goto err_out_driver;
3300
3301        return 0;
3302
3303err_out_driver:
3304        mempool_destroy(sd_cdb_pool);
3305
3306err_out_cache:
3307        kmem_cache_destroy(sd_cdb_cache);
3308
3309err_out_class:
3310        class_unregister(&sd_disk_class);
3311err_out:
3312        for (i = 0; i < SD_MAJORS; i++)
3313                unregister_blkdev(sd_major(i), "sd");
3314        return err;
3315}
3316
3317/**
3318 *      exit_sd - exit point for this driver (when it is a module).
3319 *
3320 *      Note: this function unregisters this driver from the scsi mid-level.
3321 **/
3322static void __exit exit_sd(void)
3323{
3324        int i;
3325
3326        SCSI_LOG_HLQUEUE(3, printk("exit_sd: exiting sd driver\n"));
3327
3328        scsi_unregister_driver(&sd_template.gendrv);
3329        mempool_destroy(sd_cdb_pool);
3330        kmem_cache_destroy(sd_cdb_cache);
3331
3332        class_unregister(&sd_disk_class);
3333
3334        for (i = 0; i < SD_MAJORS; i++) {
3335                blk_unregister_region(sd_major(i), SD_MINORS);
3336                unregister_blkdev(sd_major(i), "sd");
3337        }
3338}
3339
3340module_init(init_sd);
3341module_exit(exit_sd);
3342
3343static void sd_print_sense_hdr(struct scsi_disk *sdkp,
3344                               struct scsi_sense_hdr *sshdr)
3345{
3346        sd_printk(KERN_INFO, sdkp, " ");
3347        scsi_show_sense_hdr(sshdr);
3348        sd_printk(KERN_INFO, sdkp, " ");
3349        scsi_show_extd_sense(sshdr->asc, sshdr->ascq);
3350}
3351
3352static void sd_print_result(struct scsi_disk *sdkp, int result)
3353{
3354        sd_printk(KERN_INFO, sdkp, " ");
3355        scsi_show_result(result);
3356}
3357
Note: See TracBrowser for help on using the repository browser.