[SCSI] Do not retry a request whose data integrity check failed
[linux-2.6-block.git] / drivers / scsi / sd.c
CommitLineData
1da177e4
LT
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
1da177e4
LT
35#include <linux/module.h>
36#include <linux/fs.h>
37#include <linux/kernel.h>
1da177e4
LT
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>
1da177e4 48#include <linux/delay.h>
0b950672 49#include <linux/mutex.h>
1da177e4
LT
50#include <asm/uaccess.h>
51
52#include <scsi/scsi.h>
53#include <scsi/scsi_cmnd.h>
54#include <scsi/scsi_dbg.h>
55#include <scsi/scsi_device.h>
56#include <scsi/scsi_driver.h>
57#include <scsi/scsi_eh.h>
58#include <scsi/scsi_host.h>
59#include <scsi/scsi_ioctl.h>
1da177e4
LT
60#include <scsi/scsicam.h>
61
aa91696e 62#include "sd.h"
1da177e4
LT
63#include "scsi_logging.h"
64
f018fa55
RH
65MODULE_AUTHOR("Eric Youngdale");
66MODULE_DESCRIPTION("SCSI disk (sd) driver");
67MODULE_LICENSE("GPL");
68
69MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK0_MAJOR);
70MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK1_MAJOR);
71MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK2_MAJOR);
72MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK3_MAJOR);
73MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK4_MAJOR);
74MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK5_MAJOR);
75MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK6_MAJOR);
76MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK7_MAJOR);
77MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK8_MAJOR);
78MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK9_MAJOR);
79MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK10_MAJOR);
80MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK11_MAJOR);
81MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK12_MAJOR);
82MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK13_MAJOR);
83MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK14_MAJOR);
84MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK15_MAJOR);
d7b8bcb0
MT
85MODULE_ALIAS_SCSI_DEVICE(TYPE_DISK);
86MODULE_ALIAS_SCSI_DEVICE(TYPE_MOD);
87MODULE_ALIAS_SCSI_DEVICE(TYPE_RBC);
f018fa55 88
7b3d9545
LT
89static int sd_revalidate_disk(struct gendisk *);
90static int sd_probe(struct device *);
91static int sd_remove(struct device *);
92static void sd_shutdown(struct device *);
93static int sd_suspend(struct device *, pm_message_t state);
94static int sd_resume(struct device *);
95static void sd_rescan(struct device *);
96static int sd_done(struct scsi_cmnd *);
97static void sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer);
ee959b00 98static void scsi_disk_release(struct device *cdev);
7b3d9545
LT
99static void sd_print_sense_hdr(struct scsi_disk *, struct scsi_sense_hdr *);
100static void sd_print_result(struct scsi_disk *, int);
101
f27bac27 102static DEFINE_IDA(sd_index_ida);
1da177e4
LT
103
104/* This semaphore is used to mediate the 0->1 reference get in the
105 * face of object destruction (i.e. we can't allow a get on an
106 * object after last put) */
0b950672 107static DEFINE_MUTEX(sd_ref_mutex);
1da177e4 108
6bdaa1f1
JB
109static const char *sd_cache_types[] = {
110 "write through", "none", "write back",
111 "write back, no read (daft)"
112};
113
ee959b00
TJ
114static ssize_t
115sd_store_cache_type(struct device *dev, struct device_attribute *attr,
116 const char *buf, size_t count)
6bdaa1f1
JB
117{
118 int i, ct = -1, rcd, wce, sp;
ee959b00 119 struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f1
JB
120 struct scsi_device *sdp = sdkp->device;
121 char buffer[64];
122 char *buffer_data;
123 struct scsi_mode_data data;
124 struct scsi_sense_hdr sshdr;
125 int len;
126
127 if (sdp->type != TYPE_DISK)
128 /* no cache control on RBC devices; theoretically they
129 * can do it, but there's probably so many exceptions
130 * it's not worth the risk */
131 return -EINVAL;
132
6391a113 133 for (i = 0; i < ARRAY_SIZE(sd_cache_types); i++) {
6bdaa1f1
JB
134 const int len = strlen(sd_cache_types[i]);
135 if (strncmp(sd_cache_types[i], buf, len) == 0 &&
136 buf[len] == '\n') {
137 ct = i;
138 break;
139 }
140 }
141 if (ct < 0)
142 return -EINVAL;
143 rcd = ct & 0x01 ? 1 : 0;
144 wce = ct & 0x02 ? 1 : 0;
145 if (scsi_mode_sense(sdp, 0x08, 8, buffer, sizeof(buffer), SD_TIMEOUT,
146 SD_MAX_RETRIES, &data, NULL))
147 return -EINVAL;
a9312fb8 148 len = min_t(size_t, sizeof(buffer), data.length - data.header_length -
6bdaa1f1
JB
149 data.block_descriptor_length);
150 buffer_data = buffer + data.header_length +
151 data.block_descriptor_length;
152 buffer_data[2] &= ~0x05;
153 buffer_data[2] |= wce << 2 | rcd;
154 sp = buffer_data[0] & 0x80 ? 1 : 0;
155
156 if (scsi_mode_select(sdp, 1, sp, 8, buffer_data, len, SD_TIMEOUT,
157 SD_MAX_RETRIES, &data, &sshdr)) {
158 if (scsi_sense_valid(&sshdr))
e73aec82 159 sd_print_sense_hdr(sdkp, &sshdr);
6bdaa1f1
JB
160 return -EINVAL;
161 }
162 sd_revalidate_disk(sdkp->disk);
163 return count;
164}
165
ee959b00
TJ
166static ssize_t
167sd_store_manage_start_stop(struct device *dev, struct device_attribute *attr,
168 const char *buf, size_t count)
c3c94c5a 169{
ee959b00 170 struct scsi_disk *sdkp = to_scsi_disk(dev);
c3c94c5a
TH
171 struct scsi_device *sdp = sdkp->device;
172
173 if (!capable(CAP_SYS_ADMIN))
174 return -EACCES;
175
176 sdp->manage_start_stop = simple_strtoul(buf, NULL, 10);
177
178 return count;
179}
180
ee959b00
TJ
181static ssize_t
182sd_store_allow_restart(struct device *dev, struct device_attribute *attr,
183 const char *buf, size_t count)
a144c5ae 184{
ee959b00 185 struct scsi_disk *sdkp = to_scsi_disk(dev);
a144c5ae
BK
186 struct scsi_device *sdp = sdkp->device;
187
188 if (!capable(CAP_SYS_ADMIN))
189 return -EACCES;
190
191 if (sdp->type != TYPE_DISK)
192 return -EINVAL;
193
194 sdp->allow_restart = simple_strtoul(buf, NULL, 10);
195
196 return count;
197}
198
ee959b00
TJ
199static ssize_t
200sd_show_cache_type(struct device *dev, struct device_attribute *attr,
201 char *buf)
6bdaa1f1 202{
ee959b00 203 struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f1
JB
204 int ct = sdkp->RCD + 2*sdkp->WCE;
205
206 return snprintf(buf, 40, "%s\n", sd_cache_types[ct]);
207}
208
ee959b00
TJ
209static ssize_t
210sd_show_fua(struct device *dev, struct device_attribute *attr, char *buf)
6bdaa1f1 211{
ee959b00 212 struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f1
JB
213
214 return snprintf(buf, 20, "%u\n", sdkp->DPOFUA);
215}
216
ee959b00
TJ
217static ssize_t
218sd_show_manage_start_stop(struct device *dev, struct device_attribute *attr,
219 char *buf)
c3c94c5a 220{
ee959b00 221 struct scsi_disk *sdkp = to_scsi_disk(dev);
c3c94c5a
TH
222 struct scsi_device *sdp = sdkp->device;
223
224 return snprintf(buf, 20, "%u\n", sdp->manage_start_stop);
225}
226
ee959b00
TJ
227static ssize_t
228sd_show_allow_restart(struct device *dev, struct device_attribute *attr,
229 char *buf)
a144c5ae 230{
ee959b00 231 struct scsi_disk *sdkp = to_scsi_disk(dev);
a144c5ae
BK
232
233 return snprintf(buf, 40, "%d\n", sdkp->device->allow_restart);
234}
235
ee959b00 236static struct device_attribute sd_disk_attrs[] = {
6bdaa1f1
JB
237 __ATTR(cache_type, S_IRUGO|S_IWUSR, sd_show_cache_type,
238 sd_store_cache_type),
239 __ATTR(FUA, S_IRUGO, sd_show_fua, NULL),
a144c5ae
BK
240 __ATTR(allow_restart, S_IRUGO|S_IWUSR, sd_show_allow_restart,
241 sd_store_allow_restart),
c3c94c5a
TH
242 __ATTR(manage_start_stop, S_IRUGO|S_IWUSR, sd_show_manage_start_stop,
243 sd_store_manage_start_stop),
6bdaa1f1
JB
244 __ATTR_NULL,
245};
246
247static struct class sd_disk_class = {
248 .name = "scsi_disk",
249 .owner = THIS_MODULE,
ee959b00
TJ
250 .dev_release = scsi_disk_release,
251 .dev_attrs = sd_disk_attrs,
6bdaa1f1 252};
1da177e4
LT
253
254static struct scsi_driver sd_template = {
255 .owner = THIS_MODULE,
256 .gendrv = {
257 .name = "sd",
258 .probe = sd_probe,
259 .remove = sd_remove,
c3c94c5a
TH
260 .suspend = sd_suspend,
261 .resume = sd_resume,
1da177e4
LT
262 .shutdown = sd_shutdown,
263 },
264 .rescan = sd_rescan,
7b3d9545 265 .done = sd_done,
1da177e4
LT
266};
267
268/*
269 * Device no to disk mapping:
270 *
271 * major disc2 disc p1
272 * |............|.............|....|....| <- dev_t
273 * 31 20 19 8 7 4 3 0
274 *
275 * Inside a major, we have 16k disks, however mapped non-
276 * contiguously. The first 16 disks are for major0, the next
277 * ones with major1, ... Disk 256 is for major0 again, disk 272
278 * for major1, ...
279 * As we stay compatible with our numbering scheme, we can reuse
280 * the well-know SCSI majors 8, 65--71, 136--143.
281 */
282static int sd_major(int major_idx)
283{
284 switch (major_idx) {
285 case 0:
286 return SCSI_DISK0_MAJOR;
287 case 1 ... 7:
288 return SCSI_DISK1_MAJOR + major_idx - 1;
289 case 8 ... 15:
290 return SCSI_DISK8_MAJOR + major_idx - 8;
291 default:
292 BUG();
293 return 0; /* shut up gcc */
294 }
295}
296
39b7f1e2 297static struct scsi_disk *__scsi_disk_get(struct gendisk *disk)
1da177e4
LT
298{
299 struct scsi_disk *sdkp = NULL;
300
39b7f1e2
AS
301 if (disk->private_data) {
302 sdkp = scsi_disk(disk);
303 if (scsi_device_get(sdkp->device) == 0)
ee959b00 304 get_device(&sdkp->dev);
39b7f1e2
AS
305 else
306 sdkp = NULL;
307 }
308 return sdkp;
309}
310
311static struct scsi_disk *scsi_disk_get(struct gendisk *disk)
312{
313 struct scsi_disk *sdkp;
314
0b950672 315 mutex_lock(&sd_ref_mutex);
39b7f1e2 316 sdkp = __scsi_disk_get(disk);
0b950672 317 mutex_unlock(&sd_ref_mutex);
1da177e4 318 return sdkp;
39b7f1e2 319}
1da177e4 320
39b7f1e2
AS
321static struct scsi_disk *scsi_disk_get_from_dev(struct device *dev)
322{
323 struct scsi_disk *sdkp;
324
0b950672 325 mutex_lock(&sd_ref_mutex);
39b7f1e2
AS
326 sdkp = dev_get_drvdata(dev);
327 if (sdkp)
328 sdkp = __scsi_disk_get(sdkp->disk);
0b950672 329 mutex_unlock(&sd_ref_mutex);
1da177e4
LT
330 return sdkp;
331}
332
333static void scsi_disk_put(struct scsi_disk *sdkp)
334{
335 struct scsi_device *sdev = sdkp->device;
336
0b950672 337 mutex_lock(&sd_ref_mutex);
ee959b00 338 put_device(&sdkp->dev);
1da177e4 339 scsi_device_put(sdev);
0b950672 340 mutex_unlock(&sd_ref_mutex);
1da177e4
LT
341}
342
343/**
344 * sd_init_command - build a scsi (read or write) command from
345 * information in the request structure.
346 * @SCpnt: pointer to mid-level's per scsi command structure that
347 * contains request and into which the scsi command is written
348 *
349 * Returns 1 if successful and 0 if error (or cannot be done now).
350 **/
7f9a6bc4 351static int sd_prep_fn(struct request_queue *q, struct request *rq)
1da177e4 352{
7f9a6bc4
JB
353 struct scsi_cmnd *SCpnt;
354 struct scsi_device *sdp = q->queuedata;
776b23a0
CH
355 struct gendisk *disk = rq->rq_disk;
356 sector_t block = rq->sector;
7f9a6bc4 357 unsigned int this_count = rq->nr_sectors;
776b23a0 358 unsigned int timeout = sdp->timeout;
7f9a6bc4
JB
359 int ret;
360
361 if (rq->cmd_type == REQ_TYPE_BLOCK_PC) {
362 ret = scsi_setup_blk_pc_cmnd(sdp, rq);
363 goto out;
364 } else if (rq->cmd_type != REQ_TYPE_FS) {
365 ret = BLKPREP_KILL;
366 goto out;
367 }
368 ret = scsi_setup_fs_cmnd(sdp, rq);
369 if (ret != BLKPREP_OK)
370 goto out;
371 SCpnt = rq->special;
372
373 /* from here on until we're complete, any goto out
374 * is used for a killable error condition */
375 ret = BLKPREP_KILL;
1da177e4 376
fa0d34be
MP
377 SCSI_LOG_HLQUEUE(1, scmd_printk(KERN_INFO, SCpnt,
378 "sd_init_command: block=%llu, "
379 "count=%d\n",
380 (unsigned long long)block,
381 this_count));
1da177e4
LT
382
383 if (!sdp || !scsi_device_online(sdp) ||
384 block + rq->nr_sectors > get_capacity(disk)) {
fa0d34be
MP
385 SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
386 "Finishing %ld sectors\n",
387 rq->nr_sectors));
388 SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
389 "Retry with 0x%p\n", SCpnt));
7f9a6bc4 390 goto out;
1da177e4
LT
391 }
392
393 if (sdp->changed) {
394 /*
395 * quietly refuse to do anything to a changed disc until
396 * the changed bit has been reset
397 */
398 /* printk("SCSI disk has been changed. Prohibiting further I/O.\n"); */
7f9a6bc4 399 goto out;
1da177e4 400 }
7f9a6bc4 401
a0899d4d
HG
402 /*
403 * Some devices (some sdcards for one) don't like it if the
404 * last sector gets read in a larger then 1 sector read.
405 */
406 if (unlikely(sdp->last_sector_bug &&
407 rq->nr_sectors > sdp->sector_size / 512 &&
408 block + this_count == get_capacity(disk)))
409 this_count -= sdp->sector_size / 512;
410
fa0d34be
MP
411 SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt, "block=%llu\n",
412 (unsigned long long)block));
1da177e4
LT
413
414 /*
415 * If we have a 1K hardware sectorsize, prevent access to single
416 * 512 byte sectors. In theory we could handle this - in fact
417 * the scsi cdrom driver must be able to handle this because
418 * we typically use 1K blocksizes, and cdroms typically have
419 * 2K hardware sectorsizes. Of course, things are simpler
420 * with the cdrom, since it is read-only. For performance
421 * reasons, the filesystems should be able to handle this
422 * and not force the scsi disk driver to use bounce buffers
423 * for this.
424 */
425 if (sdp->sector_size == 1024) {
426 if ((block & 1) || (rq->nr_sectors & 1)) {
e73aec82
MP
427 scmd_printk(KERN_ERR, SCpnt,
428 "Bad block number requested\n");
7f9a6bc4 429 goto out;
1da177e4
LT
430 } else {
431 block = block >> 1;
432 this_count = this_count >> 1;
433 }
434 }
435 if (sdp->sector_size == 2048) {
436 if ((block & 3) || (rq->nr_sectors & 3)) {
e73aec82
MP
437 scmd_printk(KERN_ERR, SCpnt,
438 "Bad block number requested\n");
7f9a6bc4 439 goto out;
1da177e4
LT
440 } else {
441 block = block >> 2;
442 this_count = this_count >> 2;
443 }
444 }
445 if (sdp->sector_size == 4096) {
446 if ((block & 7) || (rq->nr_sectors & 7)) {
e73aec82
MP
447 scmd_printk(KERN_ERR, SCpnt,
448 "Bad block number requested\n");
7f9a6bc4 449 goto out;
1da177e4
LT
450 } else {
451 block = block >> 3;
452 this_count = this_count >> 3;
453 }
454 }
455 if (rq_data_dir(rq) == WRITE) {
456 if (!sdp->writeable) {
7f9a6bc4 457 goto out;
1da177e4
LT
458 }
459 SCpnt->cmnd[0] = WRITE_6;
460 SCpnt->sc_data_direction = DMA_TO_DEVICE;
461 } else if (rq_data_dir(rq) == READ) {
462 SCpnt->cmnd[0] = READ_6;
463 SCpnt->sc_data_direction = DMA_FROM_DEVICE;
464 } else {
e73aec82 465 scmd_printk(KERN_ERR, SCpnt, "Unknown command %x\n", rq->cmd_flags);
7f9a6bc4 466 goto out;
1da177e4
LT
467 }
468
fa0d34be
MP
469 SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
470 "%s %d/%ld 512 byte blocks.\n",
471 (rq_data_dir(rq) == WRITE) ?
472 "writing" : "reading", this_count,
473 rq->nr_sectors));
1da177e4
LT
474
475 SCpnt->cmnd[1] = 0;
476
477 if (block > 0xffffffff) {
478 SCpnt->cmnd[0] += READ_16 - READ_6;
007365ad 479 SCpnt->cmnd[1] |= blk_fua_rq(rq) ? 0x8 : 0;
1da177e4
LT
480 SCpnt->cmnd[2] = sizeof(block) > 4 ? (unsigned char) (block >> 56) & 0xff : 0;
481 SCpnt->cmnd[3] = sizeof(block) > 4 ? (unsigned char) (block >> 48) & 0xff : 0;
482 SCpnt->cmnd[4] = sizeof(block) > 4 ? (unsigned char) (block >> 40) & 0xff : 0;
483 SCpnt->cmnd[5] = sizeof(block) > 4 ? (unsigned char) (block >> 32) & 0xff : 0;
484 SCpnt->cmnd[6] = (unsigned char) (block >> 24) & 0xff;
485 SCpnt->cmnd[7] = (unsigned char) (block >> 16) & 0xff;
486 SCpnt->cmnd[8] = (unsigned char) (block >> 8) & 0xff;
487 SCpnt->cmnd[9] = (unsigned char) block & 0xff;
488 SCpnt->cmnd[10] = (unsigned char) (this_count >> 24) & 0xff;
489 SCpnt->cmnd[11] = (unsigned char) (this_count >> 16) & 0xff;
490 SCpnt->cmnd[12] = (unsigned char) (this_count >> 8) & 0xff;
491 SCpnt->cmnd[13] = (unsigned char) this_count & 0xff;
492 SCpnt->cmnd[14] = SCpnt->cmnd[15] = 0;
493 } else if ((this_count > 0xff) || (block > 0x1fffff) ||
494 SCpnt->device->use_10_for_rw) {
495 if (this_count > 0xffff)
496 this_count = 0xffff;
497
498 SCpnt->cmnd[0] += READ_10 - READ_6;
007365ad 499 SCpnt->cmnd[1] |= blk_fua_rq(rq) ? 0x8 : 0;
1da177e4
LT
500 SCpnt->cmnd[2] = (unsigned char) (block >> 24) & 0xff;
501 SCpnt->cmnd[3] = (unsigned char) (block >> 16) & 0xff;
502 SCpnt->cmnd[4] = (unsigned char) (block >> 8) & 0xff;
503 SCpnt->cmnd[5] = (unsigned char) block & 0xff;
504 SCpnt->cmnd[6] = SCpnt->cmnd[9] = 0;
505 SCpnt->cmnd[7] = (unsigned char) (this_count >> 8) & 0xff;
506 SCpnt->cmnd[8] = (unsigned char) this_count & 0xff;
507 } else {
007365ad
TH
508 if (unlikely(blk_fua_rq(rq))) {
509 /*
510 * This happens only if this drive failed
511 * 10byte rw command with ILLEGAL_REQUEST
512 * during operation and thus turned off
513 * use_10_for_rw.
514 */
e73aec82
MP
515 scmd_printk(KERN_ERR, SCpnt,
516 "FUA write on READ/WRITE(6) drive\n");
7f9a6bc4 517 goto out;
007365ad
TH
518 }
519
1da177e4
LT
520 SCpnt->cmnd[1] |= (unsigned char) ((block >> 16) & 0x1f);
521 SCpnt->cmnd[2] = (unsigned char) ((block >> 8) & 0xff);
522 SCpnt->cmnd[3] = (unsigned char) block & 0xff;
523 SCpnt->cmnd[4] = (unsigned char) this_count;
524 SCpnt->cmnd[5] = 0;
525 }
30b0c37b 526 SCpnt->sdb.length = this_count * sdp->sector_size;
1da177e4
LT
527
528 /*
529 * We shouldn't disconnect in the middle of a sector, so with a dumb
530 * host adapter, it's safe to assume that we can at least transfer
531 * this many bytes between each connect / disconnect.
532 */
533 SCpnt->transfersize = sdp->sector_size;
534 SCpnt->underflow = this_count << 9;
535 SCpnt->allowed = SD_MAX_RETRIES;
1da177e4
LT
536 SCpnt->timeout_per_command = timeout;
537
1da177e4
LT
538 /*
539 * This indicates that the command is ready from our end to be
540 * queued.
541 */
7f9a6bc4
JB
542 ret = BLKPREP_OK;
543 out:
544 return scsi_prep_return(q, rq, ret);
1da177e4
LT
545}
546
547/**
548 * sd_open - open a scsi disk device
549 * @inode: only i_rdev member may be used
550 * @filp: only f_mode and f_flags may be used
551 *
552 * Returns 0 if successful. Returns a negated errno value in case
553 * of error.
554 *
555 * Note: This can be called from a user context (e.g. fsck(1) )
556 * or from within the kernel (e.g. as a result of a mount(1) ).
557 * In the latter case @inode and @filp carry an abridged amount
558 * of information as noted above.
559 **/
560static int sd_open(struct inode *inode, struct file *filp)
561{
562 struct gendisk *disk = inode->i_bdev->bd_disk;
563 struct scsi_disk *sdkp;
564 struct scsi_device *sdev;
565 int retval;
566
567 if (!(sdkp = scsi_disk_get(disk)))
568 return -ENXIO;
569
570
fa0d34be 571 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_open\n"));
1da177e4
LT
572
573 sdev = sdkp->device;
574
575 /*
576 * If the device is in error recovery, wait until it is done.
577 * If the device is offline, then disallow any access to it.
578 */
579 retval = -ENXIO;
580 if (!scsi_block_when_processing_errors(sdev))
581 goto error_out;
582
583 if (sdev->removable || sdkp->write_prot)
584 check_disk_change(inode->i_bdev);
585
586 /*
587 * If the drive is empty, just let the open fail.
588 */
589 retval = -ENOMEDIUM;
590 if (sdev->removable && !sdkp->media_present &&
591 !(filp->f_flags & O_NDELAY))
592 goto error_out;
593
594 /*
595 * If the device has the write protect tab set, have the open fail
596 * if the user expects to be able to write to the thing.
597 */
598 retval = -EROFS;
599 if (sdkp->write_prot && (filp->f_mode & FMODE_WRITE))
600 goto error_out;
601
602 /*
603 * It is possible that the disk changing stuff resulted in
604 * the device being taken offline. If this is the case,
605 * report this to the user, and don't pretend that the
606 * open actually succeeded.
607 */
608 retval = -ENXIO;
609 if (!scsi_device_online(sdev))
610 goto error_out;
611
612 if (!sdkp->openers++ && sdev->removable) {
613 if (scsi_block_when_processing_errors(sdev))
614 scsi_set_medium_removal(sdev, SCSI_REMOVAL_PREVENT);
615 }
616
617 return 0;
618
619error_out:
620 scsi_disk_put(sdkp);
621 return retval;
622}
623
624/**
625 * sd_release - invoked when the (last) close(2) is called on this
626 * scsi disk.
627 * @inode: only i_rdev member may be used
628 * @filp: only f_mode and f_flags may be used
629 *
630 * Returns 0.
631 *
632 * Note: may block (uninterruptible) if error recovery is underway
633 * on this disk.
634 **/
635static int sd_release(struct inode *inode, struct file *filp)
636{
637 struct gendisk *disk = inode->i_bdev->bd_disk;
638 struct scsi_disk *sdkp = scsi_disk(disk);
639 struct scsi_device *sdev = sdkp->device;
640
56937f7b 641 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_release\n"));
1da177e4
LT
642
643 if (!--sdkp->openers && sdev->removable) {
644 if (scsi_block_when_processing_errors(sdev))
645 scsi_set_medium_removal(sdev, SCSI_REMOVAL_ALLOW);
646 }
647
648 /*
649 * XXX and what if there are packets in flight and this close()
650 * XXX is followed by a "rmmod sd_mod"?
651 */
652 scsi_disk_put(sdkp);
653 return 0;
654}
655
a885c8c4 656static int sd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1da177e4
LT
657{
658 struct scsi_disk *sdkp = scsi_disk(bdev->bd_disk);
659 struct scsi_device *sdp = sdkp->device;
660 struct Scsi_Host *host = sdp->host;
661 int diskinfo[4];
662
663 /* default to most commonly used values */
664 diskinfo[0] = 0x40; /* 1 << 6 */
665 diskinfo[1] = 0x20; /* 1 << 5 */
666 diskinfo[2] = sdkp->capacity >> 11;
667
668 /* override with calculated, extended default, or driver values */
669 if (host->hostt->bios_param)
670 host->hostt->bios_param(sdp, bdev, sdkp->capacity, diskinfo);
671 else
672 scsicam_bios_param(bdev, sdkp->capacity, diskinfo);
673
a885c8c4
CH
674 geo->heads = diskinfo[0];
675 geo->sectors = diskinfo[1];
676 geo->cylinders = diskinfo[2];
1da177e4
LT
677 return 0;
678}
679
680/**
681 * sd_ioctl - process an ioctl
682 * @inode: only i_rdev/i_bdev members may be used
683 * @filp: only f_mode and f_flags may be used
684 * @cmd: ioctl command number
685 * @arg: this is third argument given to ioctl(2) system call.
686 * Often contains a pointer.
687 *
688 * Returns 0 if successful (some ioctls return postive numbers on
689 * success as well). Returns a negated errno value in case of error.
690 *
691 * Note: most ioctls are forward onto the block subsystem or further
3a4fa0a2 692 * down in the scsi subsystem.
1da177e4
LT
693 **/
694static int sd_ioctl(struct inode * inode, struct file * filp,
695 unsigned int cmd, unsigned long arg)
696{
697 struct block_device *bdev = inode->i_bdev;
698 struct gendisk *disk = bdev->bd_disk;
699 struct scsi_device *sdp = scsi_disk(disk)->device;
700 void __user *p = (void __user *)arg;
701 int error;
702
703 SCSI_LOG_IOCTL(1, printk("sd_ioctl: disk=%s, cmd=0x%x\n",
704 disk->disk_name, cmd));
705
706 /*
707 * If we are in the middle of error recovery, don't let anyone
708 * else try and use this device. Also, if error recovery fails, it
709 * may try and take the device offline, in which case all further
710 * access to the device is prohibited.
711 */
712 error = scsi_nonblockable_ioctl(sdp, cmd, p, filp);
713 if (!scsi_block_when_processing_errors(sdp) || !error)
714 return error;
715
1da177e4
LT
716 /*
717 * Send SCSI addressing ioctls directly to mid level, send other
718 * ioctls to block level and then onto mid level if they can't be
719 * resolved.
720 */
721 switch (cmd) {
722 case SCSI_IOCTL_GET_IDLUN:
723 case SCSI_IOCTL_GET_BUS_NUMBER:
724 return scsi_ioctl(sdp, cmd, p);
725 default:
45e79a3a 726 error = scsi_cmd_ioctl(filp, disk->queue, disk, cmd, p);
1da177e4
LT
727 if (error != -ENOTTY)
728 return error;
729 }
730 return scsi_ioctl(sdp, cmd, p);
731}
732
733static void set_media_not_present(struct scsi_disk *sdkp)
734{
735 sdkp->media_present = 0;
736 sdkp->capacity = 0;
737 sdkp->device->changed = 1;
738}
739
740/**
741 * sd_media_changed - check if our medium changed
742 * @disk: kernel device descriptor
743 *
744 * Returns 0 if not applicable or no change; 1 if change
745 *
746 * Note: this function is invoked from the block subsystem.
747 **/
748static int sd_media_changed(struct gendisk *disk)
749{
750 struct scsi_disk *sdkp = scsi_disk(disk);
751 struct scsi_device *sdp = sdkp->device;
001aac25 752 struct scsi_sense_hdr *sshdr = NULL;
1da177e4
LT
753 int retval;
754
fa0d34be 755 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_media_changed\n"));
1da177e4
LT
756
757 if (!sdp->removable)
758 return 0;
759
760 /*
761 * If the device is offline, don't send any commands - just pretend as
762 * if the command failed. If the device ever comes back online, we
763 * can deal with it then. It is only because of unrecoverable errors
764 * that we would ever take a device offline in the first place.
765 */
285e9670
KS
766 if (!scsi_device_online(sdp)) {
767 set_media_not_present(sdkp);
768 retval = 1;
769 goto out;
770 }
1da177e4
LT
771
772 /*
773 * Using TEST_UNIT_READY enables differentiation between drive with
774 * no cartridge loaded - NOT READY, drive with changed cartridge -
775 * UNIT ATTENTION, or with same cartridge - GOOD STATUS.
776 *
777 * Drives that auto spin down. eg iomega jaz 1G, will be started
778 * by sd_spinup_disk() from sd_revalidate_disk(), which happens whenever
779 * sd_revalidate() is called.
780 */
781 retval = -ENODEV;
285e9670 782
001aac25
JB
783 if (scsi_block_when_processing_errors(sdp)) {
784 sshdr = kzalloc(sizeof(*sshdr), GFP_KERNEL);
785 retval = scsi_test_unit_ready(sdp, SD_TIMEOUT, SD_MAX_RETRIES,
786 sshdr);
787 }
1da177e4
LT
788
789 /*
790 * Unable to test, unit probably not ready. This usually
791 * means there is no disc in the drive. Mark as changed,
792 * and we will figure it out later once the drive is
793 * available again.
794 */
001aac25
JB
795 if (retval || (scsi_sense_valid(sshdr) &&
796 /* 0x3a is medium not present */
797 sshdr->asc == 0x3a)) {
285e9670
KS
798 set_media_not_present(sdkp);
799 retval = 1;
800 goto out;
801 }
1da177e4
LT
802
803 /*
804 * For removable scsi disk we have to recognise the presence
805 * of a disk in the drive. This is kept in the struct scsi_disk
806 * struct and tested at open ! Daniel Roche (dan@lectra.fr)
807 */
808 sdkp->media_present = 1;
809
810 retval = sdp->changed;
811 sdp->changed = 0;
285e9670
KS
812out:
813 if (retval != sdkp->previous_state)
814 sdev_evt_send_simple(sdp, SDEV_EVT_MEDIA_CHANGE, GFP_KERNEL);
815 sdkp->previous_state = retval;
001aac25 816 kfree(sshdr);
1da177e4 817 return retval;
1da177e4
LT
818}
819
e73aec82 820static int sd_sync_cache(struct scsi_disk *sdkp)
1da177e4 821{
1da177e4 822 int retries, res;
e73aec82 823 struct scsi_device *sdp = sdkp->device;
ea73a9f2 824 struct scsi_sense_hdr sshdr;
1da177e4
LT
825
826 if (!scsi_device_online(sdp))
827 return -ENODEV;
828
1da177e4 829
1da177e4
LT
830 for (retries = 3; retries > 0; --retries) {
831 unsigned char cmd[10] = { 0 };
832
833 cmd[0] = SYNCHRONIZE_CACHE;
834 /*
835 * Leave the rest of the command zero to indicate
836 * flush everything.
837 */
ea73a9f2
JB
838 res = scsi_execute_req(sdp, cmd, DMA_NONE, NULL, 0, &sshdr,
839 SD_TIMEOUT, SD_MAX_RETRIES);
840 if (res == 0)
1da177e4
LT
841 break;
842 }
843
e73aec82
MP
844 if (res) {
845 sd_print_result(sdkp, res);
846 if (driver_byte(res) & DRIVER_SENSE)
847 sd_print_sense_hdr(sdkp, &sshdr);
1da177e4
LT
848 }
849
3721050a
TH
850 if (res)
851 return -EIO;
852 return 0;
1da177e4
LT
853}
854
165125e1 855static void sd_prepare_flush(struct request_queue *q, struct request *rq)
1da177e4 856{
4aff5e23 857 rq->cmd_type = REQ_TYPE_BLOCK_PC;
c0ed79a3
JB
858 rq->timeout = SD_TIMEOUT;
859 rq->cmd[0] = SYNCHRONIZE_CACHE;
461d4e90 860 rq->cmd_len = 10;
1da177e4
LT
861}
862
863static void sd_rescan(struct device *dev)
864{
39b7f1e2
AS
865 struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
866
867 if (sdkp) {
868 sd_revalidate_disk(sdkp->disk);
869 scsi_disk_put(sdkp);
870 }
1da177e4
LT
871}
872
873
874#ifdef CONFIG_COMPAT
875/*
876 * This gets directly called from VFS. When the ioctl
877 * is not recognized we go back to the other translation paths.
878 */
879static long sd_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
880{
7ac6207b 881 struct block_device *bdev = file->f_path.dentry->d_inode->i_bdev;
1da177e4
LT
882 struct gendisk *disk = bdev->bd_disk;
883 struct scsi_device *sdev = scsi_disk(disk)->device;
884
885 /*
886 * If we are in the middle of error recovery, don't let anyone
887 * else try and use this device. Also, if error recovery fails, it
888 * may try and take the device offline, in which case all further
889 * access to the device is prohibited.
890 */
891 if (!scsi_block_when_processing_errors(sdev))
892 return -ENODEV;
893
894 if (sdev->host->hostt->compat_ioctl) {
895 int ret;
896
897 ret = sdev->host->hostt->compat_ioctl(sdev, cmd, (void __user *)arg);
898
899 return ret;
900 }
901
902 /*
903 * Let the static ioctl translation table take care of it.
904 */
905 return -ENOIOCTLCMD;
906}
907#endif
908
909static struct block_device_operations sd_fops = {
910 .owner = THIS_MODULE,
911 .open = sd_open,
912 .release = sd_release,
913 .ioctl = sd_ioctl,
a885c8c4 914 .getgeo = sd_getgeo,
1da177e4
LT
915#ifdef CONFIG_COMPAT
916 .compat_ioctl = sd_compat_ioctl,
917#endif
918 .media_changed = sd_media_changed,
919 .revalidate_disk = sd_revalidate_disk,
920};
921
922/**
7b3d9545 923 * sd_done - bottom half handler: called when the lower level
1da177e4
LT
924 * driver has completed (successfully or otherwise) a scsi command.
925 * @SCpnt: mid-level's per command structure.
926 *
927 * Note: potentially run from within an ISR. Must not block.
928 **/
7b3d9545 929static int sd_done(struct scsi_cmnd *SCpnt)
1da177e4
LT
930{
931 int result = SCpnt->result;
30b0c37b 932 unsigned int xfer_size = scsi_bufflen(SCpnt);
03aba2f7
LT
933 unsigned int good_bytes = result ? 0 : xfer_size;
934 u64 start_lba = SCpnt->request->sector;
366c246d 935 u64 end_lba = SCpnt->request->sector + (xfer_size / 512);
03aba2f7 936 u64 bad_lba;
1da177e4
LT
937 struct scsi_sense_hdr sshdr;
938 int sense_valid = 0;
939 int sense_deferred = 0;
940 int info_valid;
941
942 if (result) {
943 sense_valid = scsi_command_normalize_sense(SCpnt, &sshdr);
944 if (sense_valid)
945 sense_deferred = scsi_sense_is_deferred(&sshdr);
946 }
1da177e4 947#ifdef CONFIG_SCSI_LOGGING
fa0d34be 948 SCSI_LOG_HLCOMPLETE(1, scsi_print_result(SCpnt));
1da177e4 949 if (sense_valid) {
fa0d34be 950 SCSI_LOG_HLCOMPLETE(1, scmd_printk(KERN_INFO, SCpnt,
7b3d9545 951 "sd_done: sb[respc,sk,asc,"
fa0d34be
MP
952 "ascq]=%x,%x,%x,%x\n",
953 sshdr.response_code,
954 sshdr.sense_key, sshdr.asc,
955 sshdr.ascq));
1da177e4
LT
956 }
957#endif
03aba2f7
LT
958 if (driver_byte(result) != DRIVER_SENSE &&
959 (!sense_valid || sense_deferred))
960 goto out;
961
962 switch (sshdr.sense_key) {
963 case HARDWARE_ERROR:
964 case MEDIUM_ERROR:
965 if (!blk_fs_request(SCpnt->request))
966 goto out;
967 info_valid = scsi_get_sense_info_fld(SCpnt->sense_buffer,
968 SCSI_SENSE_BUFFERSIZE,
969 &bad_lba);
970 if (!info_valid)
971 goto out;
972 if (xfer_size <= SCpnt->device->sector_size)
973 goto out;
366c246d
JB
974 if (SCpnt->device->sector_size < 512) {
975 /* only legitimate sector_size here is 256 */
03aba2f7 976 start_lba <<= 1;
366c246d
JB
977 end_lba <<= 1;
978 } else {
979 /* be careful ... don't want any overflows */
980 u64 factor = SCpnt->device->sector_size / 512;
981 do_div(start_lba, factor);
982 do_div(end_lba, factor);
1da177e4 983 }
366c246d
JB
984
985 if (bad_lba < start_lba || bad_lba >= end_lba)
986 /* the bad lba was reported incorrectly, we have
987 * no idea where the error is
988 */
989 goto out;
990
03aba2f7
LT
991 /* This computation should always be done in terms of
992 * the resolution of the device's medium.
993 */
994 good_bytes = (bad_lba - start_lba)*SCpnt->device->sector_size;
995 break;
996 case RECOVERED_ERROR:
997 case NO_SENSE:
998 /* Inform the user, but make sure that it's not treated
999 * as a hard error.
1000 */
1001 scsi_print_sense("sd", SCpnt);
1002 SCpnt->result = 0;
1003 memset(SCpnt->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
1004 good_bytes = xfer_size;
1005 break;
1006 case ILLEGAL_REQUEST:
1007 if (SCpnt->device->use_10_for_rw &&
1008 (SCpnt->cmnd[0] == READ_10 ||
1009 SCpnt->cmnd[0] == WRITE_10))
1010 SCpnt->device->use_10_for_rw = 0;
1011 if (SCpnt->device->use_10_for_ms &&
1012 (SCpnt->cmnd[0] == MODE_SENSE_10 ||
1013 SCpnt->cmnd[0] == MODE_SELECT_10))
1014 SCpnt->device->use_10_for_ms = 0;
1015 break;
1016 default:
1017 break;
1da177e4 1018 }
03aba2f7 1019 out:
7b3d9545 1020 return good_bytes;
1da177e4
LT
1021}
1022
ea73a9f2
JB
1023static int media_not_present(struct scsi_disk *sdkp,
1024 struct scsi_sense_hdr *sshdr)
1da177e4 1025{
1da177e4 1026
ea73a9f2 1027 if (!scsi_sense_valid(sshdr))
1da177e4
LT
1028 return 0;
1029 /* not invoked for commands that could return deferred errors */
ea73a9f2
JB
1030 if (sshdr->sense_key != NOT_READY &&
1031 sshdr->sense_key != UNIT_ATTENTION)
1032 return 0;
1033 if (sshdr->asc != 0x3A) /* medium not present */
1034 return 0;
1035
1da177e4
LT
1036 set_media_not_present(sdkp);
1037 return 1;
1038}
1039
1040/*
1041 * spinup disk - called only in sd_revalidate_disk()
1042 */
1043static void
e73aec82 1044sd_spinup_disk(struct scsi_disk *sdkp)
ea73a9f2 1045{
1da177e4 1046 unsigned char cmd[10];
4451e472 1047 unsigned long spintime_expire = 0;
1da177e4
LT
1048 int retries, spintime;
1049 unsigned int the_result;
1050 struct scsi_sense_hdr sshdr;
1051 int sense_valid = 0;
1052
1053 spintime = 0;
1054
1055 /* Spin up drives, as required. Only do this at boot time */
1056 /* Spinup needs to be done for module loads too. */
1057 do {
1058 retries = 0;
1059
1060 do {
1061 cmd[0] = TEST_UNIT_READY;
1062 memset((void *) &cmd[1], 0, 9);
1063
ea73a9f2
JB
1064 the_result = scsi_execute_req(sdkp->device, cmd,
1065 DMA_NONE, NULL, 0,
1066 &sshdr, SD_TIMEOUT,
1067 SD_MAX_RETRIES);
1da177e4 1068
b4d38e38
AS
1069 /*
1070 * If the drive has indicated to us that it
1071 * doesn't have any media in it, don't bother
1072 * with any more polling.
1073 */
1074 if (media_not_present(sdkp, &sshdr))
1075 return;
1076
1da177e4 1077 if (the_result)
ea73a9f2 1078 sense_valid = scsi_sense_valid(&sshdr);
1da177e4
LT
1079 retries++;
1080 } while (retries < 3 &&
1081 (!scsi_status_is_good(the_result) ||
1082 ((driver_byte(the_result) & DRIVER_SENSE) &&
1083 sense_valid && sshdr.sense_key == UNIT_ATTENTION)));
1084
1da177e4
LT
1085 if ((driver_byte(the_result) & DRIVER_SENSE) == 0) {
1086 /* no sense, TUR either succeeded or failed
1087 * with a status error */
e73aec82
MP
1088 if(!spintime && !scsi_status_is_good(the_result)) {
1089 sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready\n");
1090 sd_print_result(sdkp, the_result);
1091 }
1da177e4
LT
1092 break;
1093 }
1094
1095 /*
1096 * The device does not want the automatic start to be issued.
1097 */
1098 if (sdkp->device->no_start_on_add) {
1099 break;
1100 }
1101
1102 /*
1103 * If manual intervention is required, or this is an
1104 * absent USB storage device, a spinup is meaningless.
1105 */
1106 if (sense_valid &&
1107 sshdr.sense_key == NOT_READY &&
1108 sshdr.asc == 4 && sshdr.ascq == 3) {
1109 break; /* manual intervention required */
1110
1111 /*
1112 * Issue command to spin up drive when not ready
1113 */
1114 } else if (sense_valid && sshdr.sense_key == NOT_READY) {
1115 if (!spintime) {
e73aec82 1116 sd_printk(KERN_NOTICE, sdkp, "Spinning up disk...");
1da177e4
LT
1117 cmd[0] = START_STOP;
1118 cmd[1] = 1; /* Return immediately */
1119 memset((void *) &cmd[2], 0, 8);
1120 cmd[4] = 1; /* Start spin cycle */
d2886ea3
SR
1121 if (sdkp->device->start_stop_pwr_cond)
1122 cmd[4] |= 1 << 4;
ea73a9f2
JB
1123 scsi_execute_req(sdkp->device, cmd, DMA_NONE,
1124 NULL, 0, &sshdr,
1125 SD_TIMEOUT, SD_MAX_RETRIES);
4451e472
AS
1126 spintime_expire = jiffies + 100 * HZ;
1127 spintime = 1;
1da177e4 1128 }
1da177e4
LT
1129 /* Wait 1 second for next try */
1130 msleep(1000);
1131 printk(".");
4451e472
AS
1132
1133 /*
1134 * Wait for USB flash devices with slow firmware.
1135 * Yes, this sense key/ASC combination shouldn't
1136 * occur here. It's characteristic of these devices.
1137 */
1138 } else if (sense_valid &&
1139 sshdr.sense_key == UNIT_ATTENTION &&
1140 sshdr.asc == 0x28) {
1141 if (!spintime) {
1142 spintime_expire = jiffies + 5 * HZ;
1143 spintime = 1;
1144 }
1145 /* Wait 1 second for next try */
1146 msleep(1000);
1da177e4
LT
1147 } else {
1148 /* we don't understand the sense code, so it's
1149 * probably pointless to loop */
1150 if(!spintime) {
e73aec82
MP
1151 sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready\n");
1152 sd_print_sense_hdr(sdkp, &sshdr);
1da177e4
LT
1153 }
1154 break;
1155 }
1156
4451e472 1157 } while (spintime && time_before_eq(jiffies, spintime_expire));
1da177e4
LT
1158
1159 if (spintime) {
1160 if (scsi_status_is_good(the_result))
1161 printk("ready\n");
1162 else
1163 printk("not responding...\n");
1164 }
1165}
1166
1167/*
1168 * read disk capacity
1169 */
1170static void
e73aec82 1171sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer)
ea73a9f2 1172{
1da177e4 1173 unsigned char cmd[16];
1da177e4
LT
1174 int the_result, retries;
1175 int sector_size = 0;
1176 int longrc = 0;
1177 struct scsi_sense_hdr sshdr;
1178 int sense_valid = 0;
ea73a9f2 1179 struct scsi_device *sdp = sdkp->device;
1da177e4
LT
1180
1181repeat:
1182 retries = 3;
1183 do {
1184 if (longrc) {
1185 memset((void *) cmd, 0, 16);
1186 cmd[0] = SERVICE_ACTION_IN;
1187 cmd[1] = SAI_READ_CAPACITY_16;
1188 cmd[13] = 12;
1189 memset((void *) buffer, 0, 12);
1190 } else {
1191 cmd[0] = READ_CAPACITY;
1192 memset((void *) &cmd[1], 0, 9);
1193 memset((void *) buffer, 0, 8);
1194 }
1195
ea73a9f2
JB
1196 the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
1197 buffer, longrc ? 12 : 8, &sshdr,
1198 SD_TIMEOUT, SD_MAX_RETRIES);
1da177e4 1199
ea73a9f2 1200 if (media_not_present(sdkp, &sshdr))
1da177e4
LT
1201 return;
1202
1da177e4 1203 if (the_result)
ea73a9f2 1204 sense_valid = scsi_sense_valid(&sshdr);
1da177e4
LT
1205 retries--;
1206
1207 } while (the_result && retries);
1208
1209 if (the_result && !longrc) {
e73aec82
MP
1210 sd_printk(KERN_NOTICE, sdkp, "READ CAPACITY failed\n");
1211 sd_print_result(sdkp, the_result);
1da177e4 1212 if (driver_byte(the_result) & DRIVER_SENSE)
e73aec82 1213 sd_print_sense_hdr(sdkp, &sshdr);
1da177e4 1214 else
e73aec82 1215 sd_printk(KERN_NOTICE, sdkp, "Sense not available.\n");
1da177e4
LT
1216
1217 /* Set dirty bit for removable devices if not ready -
1218 * sometimes drives will not report this properly. */
1219 if (sdp->removable &&
1220 sense_valid && sshdr.sense_key == NOT_READY)
1221 sdp->changed = 1;
1222
1223 /* Either no media are present but the drive didn't tell us,
1224 or they are present but the read capacity command fails */
1225 /* sdkp->media_present = 0; -- not always correct */
69bdd88c 1226 sdkp->capacity = 0; /* unknown mapped to zero - as usual */
1da177e4
LT
1227
1228 return;
1229 } else if (the_result && longrc) {
1230 /* READ CAPACITY(16) has been failed */
e73aec82
MP
1231 sd_printk(KERN_NOTICE, sdkp, "READ CAPACITY(16) failed\n");
1232 sd_print_result(sdkp, the_result);
1233 sd_printk(KERN_NOTICE, sdkp, "Use 0xffffffff as device size\n");
1234
1da177e4
LT
1235 sdkp->capacity = 1 + (sector_t) 0xffffffff;
1236 goto got_data;
1237 }
1238
1239 if (!longrc) {
1240 sector_size = (buffer[4] << 24) |
1241 (buffer[5] << 16) | (buffer[6] << 8) | buffer[7];
1242 if (buffer[0] == 0xff && buffer[1] == 0xff &&
1243 buffer[2] == 0xff && buffer[3] == 0xff) {
1244 if(sizeof(sdkp->capacity) > 4) {
e73aec82
MP
1245 sd_printk(KERN_NOTICE, sdkp, "Very big device. "
1246 "Trying to use READ CAPACITY(16).\n");
1da177e4
LT
1247 longrc = 1;
1248 goto repeat;
1249 }
e73aec82
MP
1250 sd_printk(KERN_ERR, sdkp, "Too big for this kernel. Use "
1251 "a kernel compiled with support for large "
1252 "block devices.\n");
1da177e4
LT
1253 sdkp->capacity = 0;
1254 goto got_data;
1255 }
1256 sdkp->capacity = 1 + (((sector_t)buffer[0] << 24) |
1257 (buffer[1] << 16) |
1258 (buffer[2] << 8) |
1259 buffer[3]);
1260 } else {
1261 sdkp->capacity = 1 + (((u64)buffer[0] << 56) |
1262 ((u64)buffer[1] << 48) |
1263 ((u64)buffer[2] << 40) |
1264 ((u64)buffer[3] << 32) |
1265 ((sector_t)buffer[4] << 24) |
1266 ((sector_t)buffer[5] << 16) |
1267 ((sector_t)buffer[6] << 8) |
1268 (sector_t)buffer[7]);
1269
1270 sector_size = (buffer[8] << 24) |
1271 (buffer[9] << 16) | (buffer[10] << 8) | buffer[11];
1272 }
1273
1274 /* Some devices return the total number of sectors, not the
1275 * highest sector number. Make the necessary adjustment. */
61bf54b7 1276 if (sdp->fix_capacity) {
1da177e4
LT
1277 --sdkp->capacity;
1278
61bf54b7
ON
1279 /* Some devices have version which report the correct sizes
1280 * and others which do not. We guess size according to a heuristic
1281 * and err on the side of lowering the capacity. */
1282 } else {
1283 if (sdp->guess_capacity)
1284 if (sdkp->capacity & 0x01) /* odd sizes are odd */
1285 --sdkp->capacity;
1286 }
1287
1da177e4
LT
1288got_data:
1289 if (sector_size == 0) {
1290 sector_size = 512;
e73aec82
MP
1291 sd_printk(KERN_NOTICE, sdkp, "Sector size 0 reported, "
1292 "assuming 512.\n");
1da177e4
LT
1293 }
1294
1295 if (sector_size != 512 &&
1296 sector_size != 1024 &&
1297 sector_size != 2048 &&
1298 sector_size != 4096 &&
1299 sector_size != 256) {
e73aec82
MP
1300 sd_printk(KERN_NOTICE, sdkp, "Unsupported sector size %d.\n",
1301 sector_size);
1da177e4
LT
1302 /*
1303 * The user might want to re-format the drive with
1304 * a supported sectorsize. Once this happens, it
1305 * would be relatively trivial to set the thing up.
1306 * For this reason, we leave the thing in the table.
1307 */
1308 sdkp->capacity = 0;
1309 /*
1310 * set a bogus sector size so the normal read/write
1311 * logic in the block layer will eventually refuse any
1312 * request on this device without tripping over power
1313 * of two sector size assumptions
1314 */
1315 sector_size = 512;
1316 }
1317 {
1318 /*
1319 * The msdos fs needs to know the hardware sector size
1320 * So I have created this table. See ll_rw_blk.c
1321 * Jacques Gelinas (Jacques@solucorp.qc.ca)
1322 */
1323 int hard_sector = sector_size;
7a691bd3 1324 sector_t sz = (sdkp->capacity/2) * (hard_sector/256);
165125e1 1325 struct request_queue *queue = sdp->request_queue;
7a691bd3 1326 sector_t mb = sz;
1da177e4
LT
1327
1328 blk_queue_hardsect_size(queue, hard_sector);
1329 /* avoid 64-bit division on 32-bit platforms */
7a691bd3 1330 sector_div(sz, 625);
1da177e4
LT
1331 mb -= sz - 974;
1332 sector_div(mb, 1950);
1333
e73aec82
MP
1334 sd_printk(KERN_NOTICE, sdkp,
1335 "%llu %d-byte hardware sectors (%llu MB)\n",
1336 (unsigned long long)sdkp->capacity,
1337 hard_sector, (unsigned long long)mb);
1da177e4
LT
1338 }
1339
1340 /* Rescale capacity to 512-byte units */
1341 if (sector_size == 4096)
1342 sdkp->capacity <<= 3;
1343 else if (sector_size == 2048)
1344 sdkp->capacity <<= 2;
1345 else if (sector_size == 1024)
1346 sdkp->capacity <<= 1;
1347 else if (sector_size == 256)
1348 sdkp->capacity >>= 1;
1349
1350 sdkp->device->sector_size = sector_size;
1351}
1352
1353/* called with buffer of length 512 */
1354static inline int
ea73a9f2
JB
1355sd_do_mode_sense(struct scsi_device *sdp, int dbd, int modepage,
1356 unsigned char *buffer, int len, struct scsi_mode_data *data,
1357 struct scsi_sense_hdr *sshdr)
1da177e4 1358{
ea73a9f2 1359 return scsi_mode_sense(sdp, dbd, modepage, buffer, len,
1cf72699 1360 SD_TIMEOUT, SD_MAX_RETRIES, data,
ea73a9f2 1361 sshdr);
1da177e4
LT
1362}
1363
1364/*
1365 * read write protect setting, if possible - called only in sd_revalidate_disk()
48970800 1366 * called with buffer of length SD_BUF_SIZE
1da177e4
LT
1367 */
1368static void
e73aec82 1369sd_read_write_protect_flag(struct scsi_disk *sdkp, unsigned char *buffer)
ea73a9f2 1370{
1da177e4 1371 int res;
ea73a9f2 1372 struct scsi_device *sdp = sdkp->device;
1da177e4
LT
1373 struct scsi_mode_data data;
1374
1375 set_disk_ro(sdkp->disk, 0);
ea73a9f2 1376 if (sdp->skip_ms_page_3f) {
e73aec82 1377 sd_printk(KERN_NOTICE, sdkp, "Assuming Write Enabled\n");
1da177e4
LT
1378 return;
1379 }
1380
ea73a9f2
JB
1381 if (sdp->use_192_bytes_for_3f) {
1382 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 192, &data, NULL);
1da177e4
LT
1383 } else {
1384 /*
1385 * First attempt: ask for all pages (0x3F), but only 4 bytes.
1386 * We have to start carefully: some devices hang if we ask
1387 * for more than is available.
1388 */
ea73a9f2 1389 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 4, &data, NULL);
1da177e4
LT
1390
1391 /*
1392 * Second attempt: ask for page 0 When only page 0 is
1393 * implemented, a request for page 3F may return Sense Key
1394 * 5: Illegal Request, Sense Code 24: Invalid field in
1395 * CDB.
1396 */
1397 if (!scsi_status_is_good(res))
ea73a9f2 1398 res = sd_do_mode_sense(sdp, 0, 0, buffer, 4, &data, NULL);
1da177e4
LT
1399
1400 /*
1401 * Third attempt: ask 255 bytes, as we did earlier.
1402 */
1403 if (!scsi_status_is_good(res))
ea73a9f2
JB
1404 res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 255,
1405 &data, NULL);
1da177e4
LT
1406 }
1407
1408 if (!scsi_status_is_good(res)) {
e73aec82
MP
1409 sd_printk(KERN_WARNING, sdkp,
1410 "Test WP failed, assume Write Enabled\n");
1da177e4
LT
1411 } else {
1412 sdkp->write_prot = ((data.device_specific & 0x80) != 0);
1413 set_disk_ro(sdkp->disk, sdkp->write_prot);
e73aec82
MP
1414 sd_printk(KERN_NOTICE, sdkp, "Write Protect is %s\n",
1415 sdkp->write_prot ? "on" : "off");
1416 sd_printk(KERN_DEBUG, sdkp,
1417 "Mode Sense: %02x %02x %02x %02x\n",
1418 buffer[0], buffer[1], buffer[2], buffer[3]);
1da177e4
LT
1419 }
1420}
1421
1422/*
1423 * sd_read_cache_type - called only from sd_revalidate_disk()
48970800 1424 * called with buffer of length SD_BUF_SIZE
1da177e4
LT
1425 */
1426static void
e73aec82 1427sd_read_cache_type(struct scsi_disk *sdkp, unsigned char *buffer)
631e8a13 1428{
1da177e4 1429 int len = 0, res;
ea73a9f2 1430 struct scsi_device *sdp = sdkp->device;
1da177e4 1431
631e8a13
AV
1432 int dbd;
1433 int modepage;
1da177e4
LT
1434 struct scsi_mode_data data;
1435 struct scsi_sense_hdr sshdr;
1436
ea73a9f2 1437 if (sdp->skip_ms_page_8)
1da177e4
LT
1438 goto defaults;
1439
ea73a9f2 1440 if (sdp->type == TYPE_RBC) {
631e8a13
AV
1441 modepage = 6;
1442 dbd = 8;
1443 } else {
1444 modepage = 8;
1445 dbd = 0;
1446 }
1447
1da177e4 1448 /* cautiously ask */
ea73a9f2 1449 res = sd_do_mode_sense(sdp, dbd, modepage, buffer, 4, &data, &sshdr);
1da177e4
LT
1450
1451 if (!scsi_status_is_good(res))
1452 goto bad_sense;
1453
6d73c851
AV
1454 if (!data.header_length) {
1455 modepage = 6;
e73aec82 1456 sd_printk(KERN_ERR, sdkp, "Missing header in MODE_SENSE response\n");
6d73c851
AV
1457 }
1458
1da177e4
LT
1459 /* that went OK, now ask for the proper length */
1460 len = data.length;
1461
1462 /*
1463 * We're only interested in the first three bytes, actually.
1464 * But the data cache page is defined for the first 20.
1465 */
1466 if (len < 3)
1467 goto bad_sense;
1468 if (len > 20)
1469 len = 20;
1470
1471 /* Take headers and block descriptors into account */
1472 len += data.header_length + data.block_descriptor_length;
48970800
AV
1473 if (len > SD_BUF_SIZE)
1474 goto bad_sense;
1da177e4
LT
1475
1476 /* Get the data */
ea73a9f2 1477 res = sd_do_mode_sense(sdp, dbd, modepage, buffer, len, &data, &sshdr);
1da177e4
LT
1478
1479 if (scsi_status_is_good(res)) {
631e8a13 1480 int offset = data.header_length + data.block_descriptor_length;
1da177e4 1481
48970800 1482 if (offset >= SD_BUF_SIZE - 2) {
e73aec82 1483 sd_printk(KERN_ERR, sdkp, "Malformed MODE SENSE response\n");
48970800
AV
1484 goto defaults;
1485 }
1486
631e8a13 1487 if ((buffer[offset] & 0x3f) != modepage) {
e73aec82 1488 sd_printk(KERN_ERR, sdkp, "Got wrong page\n");
631e8a13
AV
1489 goto defaults;
1490 }
1491
1492 if (modepage == 8) {
1493 sdkp->WCE = ((buffer[offset + 2] & 0x04) != 0);
1494 sdkp->RCD = ((buffer[offset + 2] & 0x01) != 0);
1495 } else {
1496 sdkp->WCE = ((buffer[offset + 2] & 0x01) == 0);
1497 sdkp->RCD = 0;
1498 }
1da177e4 1499
007365ad
TH
1500 sdkp->DPOFUA = (data.device_specific & 0x10) != 0;
1501 if (sdkp->DPOFUA && !sdkp->device->use_10_for_rw) {
e73aec82
MP
1502 sd_printk(KERN_NOTICE, sdkp,
1503 "Uses READ/WRITE(6), disabling FUA\n");
007365ad
TH
1504 sdkp->DPOFUA = 0;
1505 }
1506
e73aec82
MP
1507 sd_printk(KERN_NOTICE, sdkp,
1508 "Write cache: %s, read cache: %s, %s\n",
fd44bab5
LT
1509 sdkp->WCE ? "enabled" : "disabled",
1510 sdkp->RCD ? "disabled" : "enabled",
1511 sdkp->DPOFUA ? "supports DPO and FUA"
1512 : "doesn't support DPO or FUA");
1da177e4
LT
1513
1514 return;
1515 }
1516
1517bad_sense:
ea73a9f2 1518 if (scsi_sense_valid(&sshdr) &&
1da177e4
LT
1519 sshdr.sense_key == ILLEGAL_REQUEST &&
1520 sshdr.asc == 0x24 && sshdr.ascq == 0x0)
e73aec82
MP
1521 /* Invalid field in CDB */
1522 sd_printk(KERN_NOTICE, sdkp, "Cache data unavailable\n");
1da177e4 1523 else
e73aec82 1524 sd_printk(KERN_ERR, sdkp, "Asking for cache data failed\n");
1da177e4
LT
1525
1526defaults:
e73aec82 1527 sd_printk(KERN_ERR, sdkp, "Assuming drive cache: write through\n");
1da177e4
LT
1528 sdkp->WCE = 0;
1529 sdkp->RCD = 0;
48970800 1530 sdkp->DPOFUA = 0;
1da177e4
LT
1531}
1532
1533/**
1534 * sd_revalidate_disk - called the first time a new disk is seen,
1535 * performs disk spin up, read_capacity, etc.
1536 * @disk: struct gendisk we care about
1537 **/
1538static int sd_revalidate_disk(struct gendisk *disk)
1539{
1540 struct scsi_disk *sdkp = scsi_disk(disk);
1541 struct scsi_device *sdp = sdkp->device;
1da177e4 1542 unsigned char *buffer;
461d4e90 1543 unsigned ordered;
1da177e4 1544
fa0d34be
MP
1545 SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp,
1546 "sd_revalidate_disk\n"));
1da177e4
LT
1547
1548 /*
1549 * If the device is offline, don't try and read capacity or any
1550 * of the other niceties.
1551 */
1552 if (!scsi_device_online(sdp))
1553 goto out;
1554
a6123f14 1555 buffer = kmalloc(SD_BUF_SIZE, GFP_KERNEL);
1da177e4 1556 if (!buffer) {
e73aec82
MP
1557 sd_printk(KERN_WARNING, sdkp, "sd_revalidate_disk: Memory "
1558 "allocation failure.\n");
ea73a9f2 1559 goto out;
1da177e4
LT
1560 }
1561
1562 /* defaults, until the device tells us otherwise */
1563 sdp->sector_size = 512;
1564 sdkp->capacity = 0;
1565 sdkp->media_present = 1;
1566 sdkp->write_prot = 0;
1567 sdkp->WCE = 0;
1568 sdkp->RCD = 0;
1569
e73aec82 1570 sd_spinup_disk(sdkp);
1da177e4
LT
1571
1572 /*
1573 * Without media there is no reason to ask; moreover, some devices
1574 * react badly if we do.
1575 */
1576 if (sdkp->media_present) {
e73aec82
MP
1577 sd_read_capacity(sdkp, buffer);
1578 sd_read_write_protect_flag(sdkp, buffer);
1579 sd_read_cache_type(sdkp, buffer);
1da177e4 1580 }
461d4e90
TH
1581
1582 /*
1583 * We now have all cache related info, determine how we deal
1584 * with ordered requests. Note that as the current SCSI
1585 * dispatch function can alter request order, we cannot use
1586 * QUEUE_ORDERED_TAG_* even when ordered tag is supported.
1587 */
1588 if (sdkp->WCE)
007365ad
TH
1589 ordered = sdkp->DPOFUA
1590 ? QUEUE_ORDERED_DRAIN_FUA : QUEUE_ORDERED_DRAIN_FLUSH;
461d4e90
TH
1591 else
1592 ordered = QUEUE_ORDERED_DRAIN;
1593
1594 blk_queue_ordered(sdkp->disk->queue, ordered, sd_prepare_flush);
1595
1da177e4
LT
1596 set_capacity(disk, sdkp->capacity);
1597 kfree(buffer);
1598
1da177e4
LT
1599 out:
1600 return 0;
1601}
1602
1603/**
1604 * sd_probe - called during driver initialization and whenever a
1605 * new scsi device is attached to the system. It is called once
1606 * for each scsi device (not just disks) present.
1607 * @dev: pointer to device object
1608 *
1609 * Returns 0 if successful (or not interested in this scsi device
1610 * (e.g. scanner)); 1 when there is an error.
1611 *
1612 * Note: this function is invoked from the scsi mid-level.
1613 * This function sets up the mapping between a given
1614 * <host,channel,id,lun> (found in sdp) and new device name
1615 * (e.g. /dev/sda). More precisely it is the block device major
1616 * and minor number that is chosen here.
1617 *
1618 * Assume sd_attach is not re-entrant (for time being)
1619 * Also think about sd_attach() and sd_remove() running coincidentally.
1620 **/
1621static int sd_probe(struct device *dev)
1622{
1623 struct scsi_device *sdp = to_scsi_device(dev);
1624 struct scsi_disk *sdkp;
1625 struct gendisk *gd;
1626 u32 index;
1627 int error;
1628
1629 error = -ENODEV;
631e8a13 1630 if (sdp->type != TYPE_DISK && sdp->type != TYPE_MOD && sdp->type != TYPE_RBC)
1da177e4
LT
1631 goto out;
1632
9ccfc756
JB
1633 SCSI_LOG_HLQUEUE(3, sdev_printk(KERN_INFO, sdp,
1634 "sd_attach\n"));
1da177e4
LT
1635
1636 error = -ENOMEM;
24669f75 1637 sdkp = kzalloc(sizeof(*sdkp), GFP_KERNEL);
1da177e4
LT
1638 if (!sdkp)
1639 goto out;
1640
1da177e4
LT
1641 gd = alloc_disk(16);
1642 if (!gd)
1643 goto out_free;
1644
f27bac27
TH
1645 do {
1646 if (!ida_pre_get(&sd_index_ida, GFP_KERNEL))
1647 goto out_put;
1da177e4 1648
f27bac27
TH
1649 error = ida_get_new(&sd_index_ida, &index);
1650 } while (error == -EAGAIN);
1da177e4 1651
1da177e4
LT
1652 if (error)
1653 goto out_put;
1654
f27bac27
TH
1655 error = -EBUSY;
1656 if (index >= SD_MAX_DISKS)
1657 goto out_free_index;
1658
1da177e4
LT
1659 sdkp->device = sdp;
1660 sdkp->driver = &sd_template;
1661 sdkp->disk = gd;
1662 sdkp->index = index;
1663 sdkp->openers = 0;
c02e6002 1664 sdkp->previous_state = 1;
1da177e4
LT
1665
1666 if (!sdp->timeout) {
631e8a13 1667 if (sdp->type != TYPE_MOD)
1da177e4
LT
1668 sdp->timeout = SD_TIMEOUT;
1669 else
1670 sdp->timeout = SD_MOD_TIMEOUT;
1671 }
1672
ee959b00
TJ
1673 device_initialize(&sdkp->dev);
1674 sdkp->dev.parent = &sdp->sdev_gendev;
1675 sdkp->dev.class = &sd_disk_class;
1676 strncpy(sdkp->dev.bus_id, sdp->sdev_gendev.bus_id, BUS_ID_SIZE);
017f2e37 1677
ee959b00 1678 if (device_add(&sdkp->dev))
f27bac27 1679 goto out_free_index;
017f2e37
NST
1680
1681 get_device(&sdp->sdev_gendev);
1682
1da177e4
LT
1683 gd->major = sd_major((index & 0xf0) >> 4);
1684 gd->first_minor = ((index & 0xf) << 4) | (index & 0xfff00);
1685 gd->minors = 16;
1686 gd->fops = &sd_fops;
1687
1688 if (index < 26) {
1689 sprintf(gd->disk_name, "sd%c", 'a' + index % 26);
1690 } else if (index < (26 + 1) * 26) {
1691 sprintf(gd->disk_name, "sd%c%c",
1692 'a' + index / 26 - 1,'a' + index % 26);
1693 } else {
1694 const unsigned int m1 = (index / 26 - 1) / 26 - 1;
1695 const unsigned int m2 = (index / 26 - 1) % 26;
1696 const unsigned int m3 = index % 26;
1697 sprintf(gd->disk_name, "sd%c%c%c",
1698 'a' + m1, 'a' + m2, 'a' + m3);
1699 }
1700
1da177e4 1701 gd->private_data = &sdkp->driver;
461d4e90 1702 gd->queue = sdkp->device->request_queue;
1da177e4
LT
1703
1704 sd_revalidate_disk(gd);
1705
7f9a6bc4 1706 blk_queue_prep_rq(sdp->request_queue, sd_prep_fn);
03a5743a 1707
1da177e4
LT
1708 gd->driverfs_dev = &sdp->sdev_gendev;
1709 gd->flags = GENHD_FL_DRIVERFS;
1710 if (sdp->removable)
1711 gd->flags |= GENHD_FL_REMOVABLE;
1da177e4
LT
1712
1713 dev_set_drvdata(dev, sdkp);
1714 add_disk(gd);
1715
e73aec82
MP
1716 sd_printk(KERN_NOTICE, sdkp, "Attached SCSI %sdisk\n",
1717 sdp->removable ? "removable " : "");
1da177e4
LT
1718
1719 return 0;
1720
f27bac27
TH
1721 out_free_index:
1722 ida_remove(&sd_index_ida, index);
6bdaa1f1 1723 out_put:
1da177e4 1724 put_disk(gd);
6bdaa1f1 1725 out_free:
1da177e4 1726 kfree(sdkp);
6bdaa1f1 1727 out:
1da177e4
LT
1728 return error;
1729}
1730
1731/**
1732 * sd_remove - called whenever a scsi disk (previously recognized by
1733 * sd_probe) is detached from the system. It is called (potentially
1734 * multiple times) during sd module unload.
1735 * @sdp: pointer to mid level scsi device object
1736 *
1737 * Note: this function is invoked from the scsi mid-level.
1738 * This function potentially frees up a device name (e.g. /dev/sdc)
1739 * that could be re-used by a subsequent sd_probe().
1740 * This function is not called when the built-in sd driver is "exit-ed".
1741 **/
1742static int sd_remove(struct device *dev)
1743{
1744 struct scsi_disk *sdkp = dev_get_drvdata(dev);
1745
ee959b00 1746 device_del(&sdkp->dev);
1da177e4
LT
1747 del_gendisk(sdkp->disk);
1748 sd_shutdown(dev);
39b7f1e2 1749
0b950672 1750 mutex_lock(&sd_ref_mutex);
39b7f1e2 1751 dev_set_drvdata(dev, NULL);
ee959b00 1752 put_device(&sdkp->dev);
0b950672 1753 mutex_unlock(&sd_ref_mutex);
1da177e4
LT
1754
1755 return 0;
1756}
1757
1758/**
1759 * scsi_disk_release - Called to free the scsi_disk structure
ee959b00 1760 * @dev: pointer to embedded class device
1da177e4 1761 *
0b950672 1762 * sd_ref_mutex must be held entering this routine. Because it is
1da177e4
LT
1763 * called on last put, you should always use the scsi_disk_get()
1764 * scsi_disk_put() helpers which manipulate the semaphore directly
ee959b00 1765 * and never do a direct put_device.
1da177e4 1766 **/
ee959b00 1767static void scsi_disk_release(struct device *dev)
1da177e4 1768{
ee959b00 1769 struct scsi_disk *sdkp = to_scsi_disk(dev);
1da177e4
LT
1770 struct gendisk *disk = sdkp->disk;
1771
f27bac27 1772 ida_remove(&sd_index_ida, sdkp->index);
1da177e4
LT
1773
1774 disk->private_data = NULL;
1da177e4 1775 put_disk(disk);
39b7f1e2 1776 put_device(&sdkp->device->sdev_gendev);
1da177e4
LT
1777
1778 kfree(sdkp);
1779}
1780
cc5d2c8c 1781static int sd_start_stop_device(struct scsi_disk *sdkp, int start)
c3c94c5a
TH
1782{
1783 unsigned char cmd[6] = { START_STOP }; /* START_VALID */
1784 struct scsi_sense_hdr sshdr;
cc5d2c8c 1785 struct scsi_device *sdp = sdkp->device;
c3c94c5a
TH
1786 int res;
1787
1788 if (start)
1789 cmd[4] |= 1; /* START */
1790
d2886ea3
SR
1791 if (sdp->start_stop_pwr_cond)
1792 cmd[4] |= start ? 1 << 4 : 3 << 4; /* Active or Standby */
1793
c3c94c5a
TH
1794 if (!scsi_device_online(sdp))
1795 return -ENODEV;
1796
1797 res = scsi_execute_req(sdp, cmd, DMA_NONE, NULL, 0, &sshdr,
1798 SD_TIMEOUT, SD_MAX_RETRIES);
1799 if (res) {
cc5d2c8c
JB
1800 sd_printk(KERN_WARNING, sdkp, "START_STOP FAILED\n");
1801 sd_print_result(sdkp, res);
c3c94c5a 1802 if (driver_byte(res) & DRIVER_SENSE)
cc5d2c8c 1803 sd_print_sense_hdr(sdkp, &sshdr);
c3c94c5a
TH
1804 }
1805
1806 return res;
1807}
1808
1da177e4
LT
1809/*
1810 * Send a SYNCHRONIZE CACHE instruction down to the device through
1811 * the normal SCSI command structure. Wait for the command to
1812 * complete.
1813 */
1814static void sd_shutdown(struct device *dev)
1815{
39b7f1e2 1816 struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
1da177e4
LT
1817
1818 if (!sdkp)
1819 return; /* this can happen */
1820
39b7f1e2 1821 if (sdkp->WCE) {
e73aec82
MP
1822 sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
1823 sd_sync_cache(sdkp);
39b7f1e2 1824 }
c3c94c5a 1825
cc5d2c8c
JB
1826 if (system_state != SYSTEM_RESTART && sdkp->device->manage_start_stop) {
1827 sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
1828 sd_start_stop_device(sdkp, 0);
c3c94c5a
TH
1829 }
1830
39b7f1e2
AS
1831 scsi_disk_put(sdkp);
1832}
1da177e4 1833
c3c94c5a
TH
1834static int sd_suspend(struct device *dev, pm_message_t mesg)
1835{
c3c94c5a 1836 struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
09ff92fe 1837 int ret = 0;
c3c94c5a
TH
1838
1839 if (!sdkp)
1840 return 0; /* this can happen */
1841
1842 if (sdkp->WCE) {
cc5d2c8c 1843 sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache\n");
c3c94c5a
TH
1844 ret = sd_sync_cache(sdkp);
1845 if (ret)
09ff92fe 1846 goto done;
c3c94c5a
TH
1847 }
1848
3a2d5b70 1849 if ((mesg.event & PM_EVENT_SLEEP) && sdkp->device->manage_start_stop) {
cc5d2c8c
JB
1850 sd_printk(KERN_NOTICE, sdkp, "Stopping disk\n");
1851 ret = sd_start_stop_device(sdkp, 0);
c3c94c5a
TH
1852 }
1853
09ff92fe
AS
1854done:
1855 scsi_disk_put(sdkp);
1856 return ret;
c3c94c5a
TH
1857}
1858
1859static int sd_resume(struct device *dev)
1860{
c3c94c5a 1861 struct scsi_disk *sdkp = scsi_disk_get_from_dev(dev);
09ff92fe 1862 int ret = 0;
c3c94c5a 1863
cc5d2c8c 1864 if (!sdkp->device->manage_start_stop)
09ff92fe 1865 goto done;
c3c94c5a 1866
cc5d2c8c 1867 sd_printk(KERN_NOTICE, sdkp, "Starting disk\n");
09ff92fe 1868 ret = sd_start_stop_device(sdkp, 1);
c3c94c5a 1869
09ff92fe
AS
1870done:
1871 scsi_disk_put(sdkp);
1872 return ret;
c3c94c5a
TH
1873}
1874
1da177e4
LT
1875/**
1876 * init_sd - entry point for this driver (both when built in or when
1877 * a module).
1878 *
1879 * Note: this function registers this driver with the scsi mid-level.
1880 **/
1881static int __init init_sd(void)
1882{
5e4009ba 1883 int majors = 0, i, err;
1da177e4
LT
1884
1885 SCSI_LOG_HLQUEUE(3, printk("init_sd: sd driver entry point\n"));
1886
1887 for (i = 0; i < SD_MAJORS; i++)
1888 if (register_blkdev(sd_major(i), "sd") == 0)
1889 majors++;
1890
1891 if (!majors)
1892 return -ENODEV;
1893
5e4009ba
JG
1894 err = class_register(&sd_disk_class);
1895 if (err)
1896 goto err_out;
6bdaa1f1 1897
5e4009ba
JG
1898 err = scsi_register_driver(&sd_template.gendrv);
1899 if (err)
1900 goto err_out_class;
1901
1902 return 0;
1903
1904err_out_class:
1905 class_unregister(&sd_disk_class);
1906err_out:
1907 for (i = 0; i < SD_MAJORS; i++)
1908 unregister_blkdev(sd_major(i), "sd");
1909 return err;
1da177e4
LT
1910}
1911
1912/**
1913 * exit_sd - exit point for this driver (when it is a module).
1914 *
1915 * Note: this function unregisters this driver from the scsi mid-level.
1916 **/
1917static void __exit exit_sd(void)
1918{
1919 int i;
1920
1921 SCSI_LOG_HLQUEUE(3, printk("exit_sd: exiting sd driver\n"));
1922
1923 scsi_unregister_driver(&sd_template.gendrv);
5e4009ba
JG
1924 class_unregister(&sd_disk_class);
1925
1da177e4
LT
1926 for (i = 0; i < SD_MAJORS; i++)
1927 unregister_blkdev(sd_major(i), "sd");
1928}
1929
1da177e4
LT
1930module_init(init_sd);
1931module_exit(exit_sd);
e73aec82
MP
1932
1933static void sd_print_sense_hdr(struct scsi_disk *sdkp,
1934 struct scsi_sense_hdr *sshdr)
1935{
1936 sd_printk(KERN_INFO, sdkp, "");
1937 scsi_show_sense_hdr(sshdr);
1938 sd_printk(KERN_INFO, sdkp, "");
1939 scsi_show_extd_sense(sshdr->asc, sshdr->ascq);
1940}
1941
1942static void sd_print_result(struct scsi_disk *sdkp, int result)
1943{
1944 sd_printk(KERN_INFO, sdkp, "");
1945 scsi_show_result(result);
1946}
1947