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