Blame view

drivers/scsi/sd.c 90.2 KB
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
  /*
   *      sd.c Copyright (C) 1992 Drew Eckhardt
   *           Copyright (C) 1993, 1994, 1995, 1999 Eric Youngdale
   *
   *      Linux scsi disk driver
   *              Initial versions: Drew Eckhardt
   *              Subsequent revisions: Eric Youngdale
   *	Modification history:
   *       - Drew Eckhardt <drew@colorado.edu> original
   *       - Eric Youngdale <eric@andante.org> add scatter-gather, multiple 
   *         outstanding request, and other enhancements.
   *         Support loadable low-level scsi drivers.
   *       - Jirka Hanika <geo@ff.cuni.cz> support more scsi disks using 
   *         eight major numbers.
   *       - Richard Gooch <rgooch@atnf.csiro.au> support devfs.
   *	 - Torben Mathiasen <tmm@image.dk> Resource allocation fixes in 
   *	   sd_init and cleanups.
   *	 - Alex Davis <letmein@erols.com> Fix problem where partition info
   *	   not being read in sd_open. Fix problem where removable media 
   *	   could be ejected after sd_open.
   *	 - Douglas Gilbert <dgilbert@interlog.com> cleanup for lk 2.5.x
   *	 - Badari Pulavarty <pbadari@us.ibm.com>, Matthew Wilcox 
   *	   <willy@debian.org>, Kurt Garloff <garloff@suse.de>: 
   *	   Support 32k/1M disks.
   *
   *	Logging policy (needs CONFIG_SCSI_LOGGING defined):
   *	 - setting up transfer: SCSI_LOG_HLQUEUE levels 1 and 2
   *	 - end of transfer (bh + scsi_lib): SCSI_LOG_HLCOMPLETE level 1
   *	 - entering sd_ioctl: SCSI_LOG_IOCTL level 1
   *	 - entering other commands: SCSI_LOG_HLQUEUE level 3
   *	Note: when the logging level is set by the user, it must be greater
   *	than the level indicated above to trigger output.	
   */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
34
35
36
  #include <linux/module.h>
  #include <linux/fs.h>
  #include <linux/kernel.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
37
38
39
40
41
42
43
44
45
46
  #include <linux/mm.h>
  #include <linux/bio.h>
  #include <linux/genhd.h>
  #include <linux/hdreg.h>
  #include <linux/errno.h>
  #include <linux/idr.h>
  #include <linux/interrupt.h>
  #include <linux/init.h>
  #include <linux/blkdev.h>
  #include <linux/blkpg.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
47
  #include <linux/delay.h>
0b9506723   Arjan van de Ven   [SCSI] turn most ...
48
  #include <linux/mutex.h>
7404ad3b6   James Bottomley   [SCSI] sd: use ge...
49
  #include <linux/string_helpers.h>
4ace92fc1   Arjan van de Ven   fastboot: make sc...
50
  #include <linux/async.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
51
  #include <linux/slab.h>
54f575884   Lin Ming   [SCSI] sd: check ...
52
  #include <linux/pm_runtime.h>
924d55b06   Christoph Hellwig   sd: implement the...
53
  #include <linux/pr.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
54
  #include <asm/uaccess.h>
8f76d151b   Dave Hansen   [SCSI] fix sign e...
55
  #include <asm/unaligned.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
56
57
58
59
60
61
62
63
64
  
  #include <scsi/scsi.h>
  #include <scsi/scsi_cmnd.h>
  #include <scsi/scsi_dbg.h>
  #include <scsi/scsi_device.h>
  #include <scsi/scsi_driver.h>
  #include <scsi/scsi_eh.h>
  #include <scsi/scsi_host.h>
  #include <scsi/scsi_ioctl.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
65
  #include <scsi/scsicam.h>
aa91696e5   Martin K. Petersen   [SCSI] sd: Move s...
66
  #include "sd.h"
a7a20d103   Dan Williams   [SCSI] sd: limit ...
67
  #include "scsi_priv.h"
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
68
  #include "scsi_logging.h"
f018fa552   Rene Herman   [SCSI] MODULE_ALI...
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
  MODULE_AUTHOR("Eric Youngdale");
  MODULE_DESCRIPTION("SCSI disk (sd) driver");
  MODULE_LICENSE("GPL");
  
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK0_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK1_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK2_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK3_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK4_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK5_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK6_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK7_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK8_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK9_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK10_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK11_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK12_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK13_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK14_MAJOR);
  MODULE_ALIAS_BLOCKDEV_MAJOR(SCSI_DISK15_MAJOR);
d7b8bcb0a   Michael Tokarev   [SCSI] modalias f...
89
90
91
  MODULE_ALIAS_SCSI_DEVICE(TYPE_DISK);
  MODULE_ALIAS_SCSI_DEVICE(TYPE_MOD);
  MODULE_ALIAS_SCSI_DEVICE(TYPE_RBC);
f018fa552   Rene Herman   [SCSI] MODULE_ALI...
92

870d66561   Tejun Heo   block: implement ...
93
  #if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
f615b48cc   Tejun Heo   sd/ide-disk: appl...
94
  #define SD_MINORS	16
870d66561   Tejun Heo   block: implement ...
95
  #else
3e1a7ff8a   Tejun Heo   block: allow disk...
96
  #define SD_MINORS	0
870d66561   Tejun Heo   block: implement ...
97
  #endif
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
98
  static void sd_config_discard(struct scsi_disk *, unsigned int);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
99
  static void sd_config_write_same(struct scsi_disk *);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
100
  static int  sd_revalidate_disk(struct gendisk *);
72ec24bd7   Tejun Heo   SCSI: implement s...
101
  static void sd_unlock_native_capacity(struct gendisk *disk);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
102
103
104
  static int  sd_probe(struct device *);
  static int  sd_remove(struct device *);
  static void sd_shutdown(struct device *);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
105
106
  static int sd_suspend_system(struct device *);
  static int sd_suspend_runtime(struct device *);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
107
108
  static int sd_resume(struct device *);
  static void sd_rescan(struct device *);
a1b73fc19   Christoph Hellwig   scsi: reintroduce...
109
110
  static int sd_init_command(struct scsi_cmnd *SCpnt);
  static void sd_uninit_command(struct scsi_cmnd *SCpnt);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
111
  static int sd_done(struct scsi_cmnd *);
2451079bc   James Bottomley   [SCSI] Fix errati...
112
  static int sd_eh_action(struct scsi_cmnd *, int);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
113
  static void sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer);
ee959b00c   Tony Jones   SCSI: convert str...
114
  static void scsi_disk_release(struct device *cdev);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
115
  static void sd_print_sense_hdr(struct scsi_disk *, struct scsi_sense_hdr *);
ef61329db   Hannes Reinecke   scsi: remove scsi...
116
  static void sd_print_result(const struct scsi_disk *, const char *, int);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
117

4034cc681   Tejun Heo   [SCSI] sd: revive...
118
  static DEFINE_SPINLOCK(sd_index_lock);
f27bac276   Tejun Heo   [SCSI] sd: update...
119
  static DEFINE_IDA(sd_index_ida);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
120
121
122
123
  
  /* This semaphore is used to mediate the 0->1 reference get in the
   * face of object destruction (i.e. we can't allow a get on an
   * object after last put) */
0b9506723   Arjan van de Ven   [SCSI] turn most ...
124
  static DEFINE_MUTEX(sd_ref_mutex);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
125

439d77f70   H Hartley Sweeten   scsi/sd.c: quiet ...
126
127
  static struct kmem_cache *sd_cdb_cache;
  static mempool_t *sd_cdb_pool;
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
128

6bdaa1f17   James Bottomley   [SCSI] allow disp...
129
130
131
132
  static const char *sd_cache_types[] = {
  	"write through", "none", "write back",
  	"write back, no read (daft)"
  };
cb2fb68d0   Vaughan Cao   sd: notify block ...
133
134
135
136
137
138
139
140
141
142
143
144
  static void sd_set_flush_flag(struct scsi_disk *sdkp)
  {
  	unsigned flush = 0;
  
  	if (sdkp->WCE) {
  		flush |= REQ_FLUSH;
  		if (sdkp->DPOFUA)
  			flush |= REQ_FUA;
  	}
  
  	blk_queue_flush(sdkp->disk->queue, flush);
  }
ee959b00c   Tony Jones   SCSI: convert str...
145
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
146
147
  cache_type_store(struct device *dev, struct device_attribute *attr,
  		 const char *buf, size_t count)
6bdaa1f17   James Bottomley   [SCSI] allow disp...
148
149
  {
  	int i, ct = -1, rcd, wce, sp;
ee959b00c   Tony Jones   SCSI: convert str...
150
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
151
152
153
154
155
  	struct scsi_device *sdp = sdkp->device;
  	char buffer[64];
  	char *buffer_data;
  	struct scsi_mode_data data;
  	struct scsi_sense_hdr sshdr;
2ee3e26c6   Ben Hutchings   [SCSI] sd: Fix pa...
156
  	static const char temp[] = "temporary ";
6bdaa1f17   James Bottomley   [SCSI] allow disp...
157
158
159
160
161
162
163
  	int len;
  
  	if (sdp->type != TYPE_DISK)
  		/* no cache control on RBC devices; theoretically they
  		 * can do it, but there's probably so many exceptions
  		 * it's not worth the risk */
  		return -EINVAL;
39c60a094   James Bottomley   [SCSI] sd: fix ar...
164
165
166
167
168
169
  	if (strncmp(buf, temp, sizeof(temp) - 1) == 0) {
  		buf += sizeof(temp) - 1;
  		sdkp->cache_override = 1;
  	} else {
  		sdkp->cache_override = 0;
  	}
6391a1137   Tobias Klauser   [SCSI] drivers/sc...
170
  	for (i = 0; i < ARRAY_SIZE(sd_cache_types); i++) {
439d77f70   H Hartley Sweeten   scsi/sd.c: quiet ...
171
  		len = strlen(sd_cache_types[i]);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
172
173
174
175
176
177
178
179
180
181
  		if (strncmp(sd_cache_types[i], buf, len) == 0 &&
  		    buf[len] == '
  ') {
  			ct = i;
  			break;
  		}
  	}
  	if (ct < 0)
  		return -EINVAL;
  	rcd = ct & 0x01 ? 1 : 0;
2eefd57b9   Sujit Reddy Thumma   sd: Avoid sending...
182
  	wce = (ct & 0x02) && !sdkp->write_prot ? 1 : 0;
39c60a094   James Bottomley   [SCSI] sd: fix ar...
183
184
185
186
  
  	if (sdkp->cache_override) {
  		sdkp->WCE = wce;
  		sdkp->RCD = rcd;
cb2fb68d0   Vaughan Cao   sd: notify block ...
187
  		sd_set_flush_flag(sdkp);
39c60a094   James Bottomley   [SCSI] sd: fix ar...
188
189
  		return count;
  	}
6bdaa1f17   James Bottomley   [SCSI] allow disp...
190
191
192
  	if (scsi_mode_sense(sdp, 0x08, 8, buffer, sizeof(buffer), SD_TIMEOUT,
  			    SD_MAX_RETRIES, &data, NULL))
  		return -EINVAL;
a9312fb83   Andrew Morton   [PATCH] git-scsi-...
193
  	len = min_t(size_t, sizeof(buffer), data.length - data.header_length -
6bdaa1f17   James Bottomley   [SCSI] allow disp...
194
195
196
197
198
199
  		  data.block_descriptor_length);
  	buffer_data = buffer + data.header_length +
  		data.block_descriptor_length;
  	buffer_data[2] &= ~0x05;
  	buffer_data[2] |= wce << 2 | rcd;
  	sp = buffer_data[0] & 0x80 ? 1 : 0;
2c5d16d6a   Gabriel Krisman Bertazi   sd: Clear PS bit ...
200
  	buffer_data[0] &= ~0x80;
6bdaa1f17   James Bottomley   [SCSI] allow disp...
201
202
203
204
  
  	if (scsi_mode_select(sdp, 1, sp, 8, buffer_data, len, SD_TIMEOUT,
  			     SD_MAX_RETRIES, &data, &sshdr)) {
  		if (scsi_sense_valid(&sshdr))
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
205
  			sd_print_sense_hdr(sdkp, &sshdr);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
206
207
  		return -EINVAL;
  	}
f98a8cae1   Andrew Patterson   SCSI sd driver ca...
208
  	revalidate_disk(sdkp->disk);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
209
210
  	return count;
  }
ee959b00c   Tony Jones   SCSI: convert str...
211
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
212
213
214
215
216
217
218
219
220
221
222
223
224
  manage_start_stop_show(struct device *dev, struct device_attribute *attr,
  		       char *buf)
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	struct scsi_device *sdp = sdkp->device;
  
  	return snprintf(buf, 20, "%u
  ", sdp->manage_start_stop);
  }
  
  static ssize_t
  manage_start_stop_store(struct device *dev, struct device_attribute *attr,
  			const char *buf, size_t count)
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
225
  {
ee959b00c   Tony Jones   SCSI: convert str...
226
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
227
228
229
230
231
232
233
234
235
  	struct scsi_device *sdp = sdkp->device;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	sdp->manage_start_stop = simple_strtoul(buf, NULL, 10);
  
  	return count;
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
236
  static DEVICE_ATTR_RW(manage_start_stop);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
237

ee959b00c   Tony Jones   SCSI: convert str...
238
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
239
240
241
242
243
244
245
246
247
248
249
  allow_restart_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 40, "%d
  ", sdkp->device->allow_restart);
  }
  
  static ssize_t
  allow_restart_store(struct device *dev, struct device_attribute *attr,
  		    const char *buf, size_t count)
a144c5ae0   Brian King   [SCSI] scsi: Add ...
250
  {
ee959b00c   Tony Jones   SCSI: convert str...
251
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
a144c5ae0   Brian King   [SCSI] scsi: Add ...
252
253
254
255
256
257
258
259
260
261
262
263
  	struct scsi_device *sdp = sdkp->device;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	if (sdp->type != TYPE_DISK)
  		return -EINVAL;
  
  	sdp->allow_restart = simple_strtoul(buf, NULL, 10);
  
  	return count;
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
264
  static DEVICE_ATTR_RW(allow_restart);
a144c5ae0   Brian King   [SCSI] scsi: Add ...
265

ee959b00c   Tony Jones   SCSI: convert str...
266
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
267
  cache_type_show(struct device *dev, struct device_attribute *attr, char *buf)
6bdaa1f17   James Bottomley   [SCSI] allow disp...
268
  {
ee959b00c   Tony Jones   SCSI: convert str...
269
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
270
271
272
273
274
  	int ct = sdkp->RCD + 2*sdkp->WCE;
  
  	return snprintf(buf, 40, "%s
  ", sd_cache_types[ct]);
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
275
  static DEVICE_ATTR_RW(cache_type);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
276

ee959b00c   Tony Jones   SCSI: convert str...
277
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
278
  FUA_show(struct device *dev, struct device_attribute *attr, char *buf)
6bdaa1f17   James Bottomley   [SCSI] allow disp...
279
  {
ee959b00c   Tony Jones   SCSI: convert str...
280
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
281
282
283
284
  
  	return snprintf(buf, 20, "%u
  ", sdkp->DPOFUA);
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
285
  static DEVICE_ATTR_RO(FUA);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
286

ee959b00c   Tony Jones   SCSI: convert str...
287
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
288
289
  protection_type_show(struct device *dev, struct device_attribute *attr,
  		     char *buf)
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
290
291
292
293
294
295
296
297
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 20, "%u
  ", sdkp->protection_type);
  }
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
298
299
  protection_type_store(struct device *dev, struct device_attribute *attr,
  		      const char *buf, size_t count)
8172499aa   Martin K. Petersen   [SCSI] sd: Allow ...
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	unsigned int val;
  	int err;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	err = kstrtouint(buf, 10, &val);
  
  	if (err)
  		return err;
  
  	if (val >= 0 && val <= SD_DIF_TYPE3_PROTECTION)
  		sdkp->protection_type = val;
  
  	return count;
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
318
  static DEVICE_ATTR_RW(protection_type);
8172499aa   Martin K. Petersen   [SCSI] sd: Allow ...
319
320
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
321
322
  protection_mode_show(struct device *dev, struct device_attribute *attr,
  		     char *buf)
518fa8e39   Martin K. Petersen   [SCSI] sd: Export...
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	struct scsi_device *sdp = sdkp->device;
  	unsigned int dif, dix;
  
  	dif = scsi_host_dif_capable(sdp->host, sdkp->protection_type);
  	dix = scsi_host_dix_capable(sdp->host, sdkp->protection_type);
  
  	if (!dix && scsi_host_dix_capable(sdp->host, SD_DIF_TYPE0_PROTECTION)) {
  		dif = 0;
  		dix = 1;
  	}
  
  	if (!dif && !dix)
  		return snprintf(buf, 20, "none
  ");
  
  	return snprintf(buf, 20, "%s%u
  ", dix ? "dix" : "dif", dif);
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
343
  static DEVICE_ATTR_RO(protection_mode);
518fa8e39   Martin K. Petersen   [SCSI] sd: Export...
344
345
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
346
  app_tag_own_show(struct device *dev, struct device_attribute *attr, char *buf)
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
347
348
349
350
351
352
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 20, "%u
  ", sdkp->ATO);
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
353
  static DEVICE_ATTR_RO(app_tag_own);
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
354

e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
355
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
356
357
  thin_provisioning_show(struct device *dev, struct device_attribute *attr,
  		       char *buf)
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
358
359
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
360
361
362
  	return snprintf(buf, 20, "%u
  ", sdkp->lbpme);
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
363
  static DEVICE_ATTR_RO(thin_provisioning);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
364
365
366
367
368
369
370
371
372
373
374
  
  static const char *lbp_mode[] = {
  	[SD_LBP_FULL]		= "full",
  	[SD_LBP_UNMAP]		= "unmap",
  	[SD_LBP_WS16]		= "writesame_16",
  	[SD_LBP_WS10]		= "writesame_10",
  	[SD_LBP_ZERO]		= "writesame_zero",
  	[SD_LBP_DISABLE]	= "disabled",
  };
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
375
376
  provisioning_mode_show(struct device *dev, struct device_attribute *attr,
  		       char *buf)
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
377
378
379
380
381
382
383
384
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 20, "%s
  ", lbp_mode[sdkp->provisioning_mode]);
  }
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
385
386
  provisioning_mode_store(struct device *dev, struct device_attribute *attr,
  			const char *buf, size_t count)
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	struct scsi_device *sdp = sdkp->device;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	if (sdp->type != TYPE_DISK)
  		return -EINVAL;
  
  	if (!strncmp(buf, lbp_mode[SD_LBP_UNMAP], 20))
  		sd_config_discard(sdkp, SD_LBP_UNMAP);
  	else if (!strncmp(buf, lbp_mode[SD_LBP_WS16], 20))
  		sd_config_discard(sdkp, SD_LBP_WS16);
  	else if (!strncmp(buf, lbp_mode[SD_LBP_WS10], 20))
  		sd_config_discard(sdkp, SD_LBP_WS10);
  	else if (!strncmp(buf, lbp_mode[SD_LBP_ZERO], 20))
  		sd_config_discard(sdkp, SD_LBP_ZERO);
  	else if (!strncmp(buf, lbp_mode[SD_LBP_DISABLE], 20))
  		sd_config_discard(sdkp, SD_LBP_DISABLE);
  	else
  		return -EINVAL;
  
  	return count;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
411
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
412
  static DEVICE_ATTR_RW(provisioning_mode);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
413

18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
414
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
415
416
  max_medium_access_timeouts_show(struct device *dev,
  				struct device_attribute *attr, char *buf)
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
417
418
419
420
421
422
423
424
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 20, "%u
  ", sdkp->max_medium_access_timeouts);
  }
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
425
426
427
  max_medium_access_timeouts_store(struct device *dev,
  				 struct device_attribute *attr, const char *buf,
  				 size_t count)
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
428
429
430
431
432
433
434
435
436
437
438
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	int err;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	err = kstrtouint(buf, 10, &sdkp->max_medium_access_timeouts);
  
  	return err ? err : count;
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
439
  static DEVICE_ATTR_RW(max_medium_access_timeouts);
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
440

5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
441
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
442
443
  max_write_same_blocks_show(struct device *dev, struct device_attribute *attr,
  			   char *buf)
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
444
445
446
447
448
449
450
451
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  
  	return snprintf(buf, 20, "%u
  ", sdkp->max_ws_blocks);
  }
  
  static ssize_t
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
452
453
  max_write_same_blocks_store(struct device *dev, struct device_attribute *attr,
  			    const char *buf, size_t count)
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
  {
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
  	struct scsi_device *sdp = sdkp->device;
  	unsigned long max;
  	int err;
  
  	if (!capable(CAP_SYS_ADMIN))
  		return -EACCES;
  
  	if (sdp->type != TYPE_DISK)
  		return -EINVAL;
  
  	err = kstrtoul(buf, 10, &max);
  
  	if (err)
  		return err;
  
  	if (max == 0)
  		sdp->no_write_same = 1;
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
473
474
  	else if (max <= SD_MAX_WS16_BLOCKS) {
  		sdp->no_write_same = 0;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
475
  		sdkp->max_ws_blocks = max;
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
476
  	}
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
477
478
479
480
481
  
  	sd_config_write_same(sdkp);
  
  	return count;
  }
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
  static DEVICE_ATTR_RW(max_write_same_blocks);
  
  static struct attribute *sd_disk_attrs[] = {
  	&dev_attr_cache_type.attr,
  	&dev_attr_FUA.attr,
  	&dev_attr_allow_restart.attr,
  	&dev_attr_manage_start_stop.attr,
  	&dev_attr_protection_type.attr,
  	&dev_attr_protection_mode.attr,
  	&dev_attr_app_tag_own.attr,
  	&dev_attr_thin_provisioning.attr,
  	&dev_attr_provisioning_mode.attr,
  	&dev_attr_max_write_same_blocks.attr,
  	&dev_attr_max_medium_access_timeouts.attr,
  	NULL,
6bdaa1f17   James Bottomley   [SCSI] allow disp...
497
  };
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
498
  ATTRIBUTE_GROUPS(sd_disk);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
499
500
501
502
  
  static struct class sd_disk_class = {
  	.name		= "scsi_disk",
  	.owner		= THIS_MODULE,
ee959b00c   Tony Jones   SCSI: convert str...
503
  	.dev_release	= scsi_disk_release,
e1ea2351f   Greg Kroah-Hartman   [SCSI] sd: conver...
504
  	.dev_groups	= sd_disk_groups,
6bdaa1f17   James Bottomley   [SCSI] allow disp...
505
  };
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
506

691e3d317   Aaron Lu   [SCSI] sd: update...
507
  static const struct dev_pm_ops sd_pm_ops = {
95897910a   Oliver Neukum   [SCSI] sd: Add er...
508
  	.suspend		= sd_suspend_system,
691e3d317   Aaron Lu   [SCSI] sd: update...
509
  	.resume			= sd_resume,
95897910a   Oliver Neukum   [SCSI] sd: Add er...
510
  	.poweroff		= sd_suspend_system,
691e3d317   Aaron Lu   [SCSI] sd: update...
511
  	.restore		= sd_resume,
95897910a   Oliver Neukum   [SCSI] sd: Add er...
512
  	.runtime_suspend	= sd_suspend_runtime,
691e3d317   Aaron Lu   [SCSI] sd: update...
513
514
  	.runtime_resume		= sd_resume,
  };
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
515
  static struct scsi_driver sd_template = {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
516
517
  	.gendrv = {
  		.name		= "sd",
3af6b3526   Christoph Hellwig   scsi: remove scsi...
518
  		.owner		= THIS_MODULE,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
519
520
521
  		.probe		= sd_probe,
  		.remove		= sd_remove,
  		.shutdown	= sd_shutdown,
691e3d317   Aaron Lu   [SCSI] sd: update...
522
  		.pm		= &sd_pm_ops,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
523
524
  	},
  	.rescan			= sd_rescan,
a1b73fc19   Christoph Hellwig   scsi: reintroduce...
525
526
  	.init_command		= sd_init_command,
  	.uninit_command		= sd_uninit_command,
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
527
  	.done			= sd_done,
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
528
  	.eh_action		= sd_eh_action,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
529
530
531
  };
  
  /*
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
532
533
534
535
536
537
538
539
540
541
   * Dummy kobj_map->probe function.
   * The default ->probe function will call modprobe, which is
   * pointless as this module is already loaded.
   */
  static struct kobject *sd_default_probe(dev_t devt, int *partno, void *data)
  {
  	return NULL;
  }
  
  /*
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
   * Device no to disk mapping:
   * 
   *       major         disc2     disc  p1
   *   |............|.............|....|....| <- dev_t
   *    31        20 19          8 7  4 3  0
   * 
   * Inside a major, we have 16k disks, however mapped non-
   * contiguously. The first 16 disks are for major0, the next
   * ones with major1, ... Disk 256 is for major0 again, disk 272 
   * for major1, ... 
   * As we stay compatible with our numbering scheme, we can reuse 
   * the well-know SCSI majors 8, 65--71, 136--143.
   */
  static int sd_major(int major_idx)
  {
  	switch (major_idx) {
  	case 0:
  		return SCSI_DISK0_MAJOR;
  	case 1 ... 7:
  		return SCSI_DISK1_MAJOR + major_idx - 1;
  	case 8 ... 15:
  		return SCSI_DISK8_MAJOR + major_idx - 8;
  	default:
  		BUG();
  		return 0;	/* shut up gcc */
  	}
  }
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
569
  static struct scsi_disk *scsi_disk_get(struct gendisk *disk)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
570
571
  {
  	struct scsi_disk *sdkp = NULL;
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
572
  	mutex_lock(&sd_ref_mutex);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
573
574
575
  	if (disk->private_data) {
  		sdkp = scsi_disk(disk);
  		if (scsi_device_get(sdkp->device) == 0)
ee959b00c   Tony Jones   SCSI: convert str...
576
  			get_device(&sdkp->dev);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
577
578
579
  		else
  			sdkp = NULL;
  	}
0b9506723   Arjan van de Ven   [SCSI] turn most ...
580
  	mutex_unlock(&sd_ref_mutex);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
581
582
583
584
585
586
  	return sdkp;
  }
  
  static void scsi_disk_put(struct scsi_disk *sdkp)
  {
  	struct scsi_device *sdev = sdkp->device;
0b9506723   Arjan van de Ven   [SCSI] turn most ...
587
  	mutex_lock(&sd_ref_mutex);
ee959b00c   Tony Jones   SCSI: convert str...
588
  	put_device(&sdkp->dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
589
  	scsi_device_put(sdev);
0b9506723   Arjan van de Ven   [SCSI] turn most ...
590
  	mutex_unlock(&sd_ref_mutex);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
591
  }
c611529e7   Martin K. Petersen   sd: Honor block l...
592
593
  static unsigned char sd_setup_protect_cmnd(struct scsi_cmnd *scmd,
  					   unsigned int dix, unsigned int dif)
35e1a5d90   Martin K. Petersen   [SCSI] sd: Detach...
594
  {
c611529e7   Martin K. Petersen   sd: Honor block l...
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
  	struct bio *bio = scmd->request->bio;
  	unsigned int prot_op = sd_prot_op(rq_data_dir(scmd->request), dix, dif);
  	unsigned int protect = 0;
  
  	if (dix) {				/* DIX Type 0, 1, 2, 3 */
  		if (bio_integrity_flagged(bio, BIP_IP_CHECKSUM))
  			scmd->prot_flags |= SCSI_PROT_IP_CHECKSUM;
  
  		if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
  			scmd->prot_flags |= SCSI_PROT_GUARD_CHECK;
  	}
  
  	if (dif != SD_DIF_TYPE3_PROTECTION) {	/* DIX/DIF Type 0, 1, 2 */
  		scmd->prot_flags |= SCSI_PROT_REF_INCREMENT;
  
  		if (bio_integrity_flagged(bio, BIP_CTRL_NOCHECK) == false)
  			scmd->prot_flags |= SCSI_PROT_REF_CHECK;
  	}
  
  	if (dif) {				/* DIX/DIF Type 1, 2, 3 */
  		scmd->prot_flags |= SCSI_PROT_TRANSFER_PI;
  
  		if (bio_integrity_flagged(bio, BIP_DISK_NOCHECK))
  			protect = 3 << 5;	/* Disable target PI checking */
  		else
  			protect = 1 << 5;	/* Enable target PI checking */
35e1a5d90   Martin K. Petersen   [SCSI] sd: Detach...
621
622
623
624
  	}
  
  	scsi_set_prot_op(scmd, prot_op);
  	scsi_set_prot_type(scmd, dif);
c611529e7   Martin K. Petersen   sd: Honor block l...
625
626
627
  	scmd->prot_flags &= sd_prot_flag_mask(prot_op);
  
  	return protect;
35e1a5d90   Martin K. Petersen   [SCSI] sd: Detach...
628
  }
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
629
630
631
632
633
  static void sd_config_discard(struct scsi_disk *sdkp, unsigned int mode)
  {
  	struct request_queue *q = sdkp->disk->queue;
  	unsigned int logical_block_size = sdkp->device->sector_size;
  	unsigned int max_blocks = 0;
7985090aa   Martin K. Petersen   sd: disable disca...
634
  	q->limits.discard_zeroes_data = 0;
397737223   Martin K. Petersen   sd: Make discard ...
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
  
  	/*
  	 * When LBPRZ is reported, discard alignment and granularity
  	 * must be fixed to the logical block size. Otherwise the block
  	 * layer will drop misaligned portions of the request which can
  	 * lead to data corruption. If LBPRZ is not set, we honor the
  	 * device preference.
  	 */
  	if (sdkp->lbprz) {
  		q->limits.discard_alignment = 0;
  		q->limits.discard_granularity = 1;
  	} else {
  		q->limits.discard_alignment = sdkp->unmap_alignment *
  			logical_block_size;
  		q->limits.discard_granularity =
  			max(sdkp->physical_block_size,
  			    sdkp->unmap_granularity * logical_block_size);
  	}
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
653

89730393f   Martin K. Petersen   [SCSI] sd: Make s...
654
  	sdkp->provisioning_mode = mode;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
655
656
657
  	switch (mode) {
  
  	case SD_LBP_DISABLE:
2bb4cd5cc   Jens Axboe   block: have drive...
658
  		blk_queue_max_discard_sectors(q, 0);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
659
660
661
662
  		queue_flag_clear_unlocked(QUEUE_FLAG_DISCARD, q);
  		return;
  
  	case SD_LBP_UNMAP:
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
663
664
  		max_blocks = min_not_zero(sdkp->max_unmap_blocks,
  					  (u32)SD_MAX_WS16_BLOCKS);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
665
666
667
  		break;
  
  	case SD_LBP_WS16:
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
668
669
  		max_blocks = min_not_zero(sdkp->max_ws_blocks,
  					  (u32)SD_MAX_WS16_BLOCKS);
7985090aa   Martin K. Petersen   sd: disable disca...
670
  		q->limits.discard_zeroes_data = sdkp->lbprz;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
671
672
673
  		break;
  
  	case SD_LBP_WS10:
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
674
675
  		max_blocks = min_not_zero(sdkp->max_ws_blocks,
  					  (u32)SD_MAX_WS10_BLOCKS);
7985090aa   Martin K. Petersen   sd: disable disca...
676
  		q->limits.discard_zeroes_data = sdkp->lbprz;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
677
678
679
  		break;
  
  	case SD_LBP_ZERO:
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
680
681
  		max_blocks = min_not_zero(sdkp->max_ws_blocks,
  					  (u32)SD_MAX_WS10_BLOCKS);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
682
683
684
  		q->limits.discard_zeroes_data = 1;
  		break;
  	}
2bb4cd5cc   Jens Axboe   block: have drive...
685
  	blk_queue_max_discard_sectors(q, max_blocks * (logical_block_size >> 9));
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
686
  	queue_flag_set_unlocked(QUEUE_FLAG_DISCARD, q);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
687
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
688
  /**
26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
689
   * sd_setup_discard_cmnd - unmap blocks on thinly provisioned device
66ac02801   Christoph Hellwig   block: don't allo...
690
   * @sdp: scsi device to operate one
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
691
692
693
694
695
   * @rq: Request to prepare
   *
   * Will issue either UNMAP or WRITE SAME(16) depending on preference
   * indicated by target device.
   **/
6a7b43985   Christoph Hellwig   sd: don't use scs...
696
  static int sd_setup_discard_cmnd(struct scsi_cmnd *cmd)
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
697
  {
6a7b43985   Christoph Hellwig   sd: don't use scs...
698
699
  	struct request *rq = cmd->request;
  	struct scsi_device *sdp = cmd->device;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
700
  	struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
701
702
703
  	sector_t sector = blk_rq_pos(rq);
  	unsigned int nr_sectors = blk_rq_sectors(rq);
  	unsigned int nr_bytes = blk_rq_bytes(rq);
66ac02801   Christoph Hellwig   block: don't allo...
704
  	unsigned int len;
f1126e950   FUJITA Tomonori   scsi: add sd_unpr...
705
  	int ret;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
706
  	char *buf;
66ac02801   Christoph Hellwig   block: don't allo...
707
  	struct page *page;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
708

26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
709
710
  	sector >>= ilog2(sdp->sector_size) - 9;
  	nr_sectors >>= ilog2(sdp->sector_size) - 9;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
711

66ac02801   Christoph Hellwig   block: don't allo...
712
713
714
  	page = alloc_page(GFP_ATOMIC | __GFP_ZERO);
  	if (!page)
  		return BLKPREP_DEFER;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
715
716
717
  	switch (sdkp->provisioning_mode) {
  	case SD_LBP_UNMAP:
  		buf = page_address(page);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
718

6a7b43985   Christoph Hellwig   sd: don't use scs...
719
720
721
  		cmd->cmd_len = 10;
  		cmd->cmnd[0] = UNMAP;
  		cmd->cmnd[8] = 24;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
722
723
724
725
  
  		put_unaligned_be16(6 + 16, &buf[0]);
  		put_unaligned_be16(16, &buf[2]);
  		put_unaligned_be64(sector, &buf[8]);
66ac02801   Christoph Hellwig   block: don't allo...
726
  		put_unaligned_be32(nr_sectors, &buf[16]);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
727

66ac02801   Christoph Hellwig   block: don't allo...
728
  		len = 24;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
729
730
731
  		break;
  
  	case SD_LBP_WS16:
6a7b43985   Christoph Hellwig   sd: don't use scs...
732
733
734
735
736
  		cmd->cmd_len = 16;
  		cmd->cmnd[0] = WRITE_SAME_16;
  		cmd->cmnd[1] = 0x8; /* UNMAP */
  		put_unaligned_be64(sector, &cmd->cmnd[2]);
  		put_unaligned_be32(nr_sectors, &cmd->cmnd[10]);
66ac02801   Christoph Hellwig   block: don't allo...
737
738
  
  		len = sdkp->device->sector_size;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
739
740
741
742
  		break;
  
  	case SD_LBP_WS10:
  	case SD_LBP_ZERO:
6a7b43985   Christoph Hellwig   sd: don't use scs...
743
744
  		cmd->cmd_len = 10;
  		cmd->cmnd[0] = WRITE_SAME;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
745
  		if (sdkp->provisioning_mode == SD_LBP_WS10)
6a7b43985   Christoph Hellwig   sd: don't use scs...
746
747
748
  			cmd->cmnd[1] = 0x8; /* UNMAP */
  		put_unaligned_be32(sector, &cmd->cmnd[2]);
  		put_unaligned_be16(nr_sectors, &cmd->cmnd[7]);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
749
750
751
752
753
  
  		len = sdkp->device->sector_size;
  		break;
  
  	default:
0fb5b1fb3   Martin K. Petersen   block/sd: Return ...
754
  		ret = BLKPREP_INVALID;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
755
  		goto out;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
756
  	}
dc4a93078   Jens Axboe   sd/skd: stuff dis...
757
  	rq->completion_data = page;
6a7b43985   Christoph Hellwig   sd: don't use scs...
758
759
760
  	rq->timeout = SD_TIMEOUT;
  
  	cmd->transfersize = len;
e4200f8ee   Christoph Hellwig   sd: retry discard...
761
  	cmd->allowed = SD_MAX_RETRIES;
6a7b43985   Christoph Hellwig   sd: don't use scs...
762
763
764
765
766
767
768
769
770
  
  	/*
  	 * Initially __data_len is set to the amount of data that needs to be
  	 * transferred to the target. This amount depends on whether WRITE SAME
  	 * or UNMAP is being used. After the scatterlist has been mapped by
  	 * scsi_init_io() we set __data_len to the size of the area to be
  	 * discarded on disk. This allows us to report completion on the full
  	 * amount of blocks described by the request.
  	 */
66ac02801   Christoph Hellwig   block: don't allo...
771
  	blk_add_request_payload(rq, page, len);
3c356bde1   Christoph Hellwig   scsi: stop passin...
772
  	ret = scsi_init_io(cmd);
26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
773
  	rq->__data_len = nr_bytes;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
774
775
  
  out:
b4f42e283   Jens Axboe   block: remove str...
776
  	if (ret != BLKPREP_OK)
610a63498   FUJITA Tomonori   scsi: fix discard...
777
  		__free_page(page);
f1126e950   FUJITA Tomonori   scsi: add sd_unpr...
778
779
  	return ret;
  }
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
780
781
782
783
  static void sd_config_write_same(struct scsi_disk *sdkp)
  {
  	struct request_queue *q = sdkp->disk->queue;
  	unsigned int logical_block_size = sdkp->device->sector_size;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
784
785
786
787
788
789
790
791
792
793
794
  
  	if (sdkp->device->no_write_same) {
  		sdkp->max_ws_blocks = 0;
  		goto out;
  	}
  
  	/* Some devices can not handle block counts above 0xffff despite
  	 * supporting WRITE SAME(16). Consequently we default to 64k
  	 * blocks per I/O unless the device explicitly advertises a
  	 * bigger limit.
  	 */
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
795
796
797
798
799
800
801
802
803
804
  	if (sdkp->max_ws_blocks > SD_MAX_WS10_BLOCKS)
  		sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
  						   (u32)SD_MAX_WS16_BLOCKS);
  	else if (sdkp->ws16 || sdkp->ws10 || sdkp->device->no_report_opcodes)
  		sdkp->max_ws_blocks = min_not_zero(sdkp->max_ws_blocks,
  						   (u32)SD_MAX_WS10_BLOCKS);
  	else {
  		sdkp->device->no_write_same = 1;
  		sdkp->max_ws_blocks = 0;
  	}
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
805
806
  
  out:
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
807
808
  	blk_queue_max_write_same_sectors(q, sdkp->max_ws_blocks *
  					 (logical_block_size >> 9));
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
809
810
811
812
  }
  
  /**
   * sd_setup_write_same_cmnd - write the same data to multiple blocks
59b1134c5   Christoph Hellwig   sd: don't use scs...
813
   * @cmd: command to prepare
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
814
815
816
817
   *
   * Will issue either WRITE SAME(10) or WRITE SAME(16) depending on
   * preference indicated by target device.
   **/
59b1134c5   Christoph Hellwig   sd: don't use scs...
818
  static int sd_setup_write_same_cmnd(struct scsi_cmnd *cmd)
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
819
  {
59b1134c5   Christoph Hellwig   sd: don't use scs...
820
821
  	struct request *rq = cmd->request;
  	struct scsi_device *sdp = cmd->device;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
822
823
824
825
826
827
828
829
  	struct scsi_disk *sdkp = scsi_disk(rq->rq_disk);
  	struct bio *bio = rq->bio;
  	sector_t sector = blk_rq_pos(rq);
  	unsigned int nr_sectors = blk_rq_sectors(rq);
  	unsigned int nr_bytes = blk_rq_bytes(rq);
  	int ret;
  
  	if (sdkp->device->no_write_same)
0fb5b1fb3   Martin K. Petersen   block/sd: Return ...
830
  		return BLKPREP_INVALID;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
831

a4ad39b1d   Kent Overstreet   block: Convert bi...
832
  	BUG_ON(bio_offset(bio) || bio_iovec(bio).bv_len != sdp->sector_size);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
833
834
835
  
  	sector >>= ilog2(sdp->sector_size) - 9;
  	nr_sectors >>= ilog2(sdp->sector_size) - 9;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
836
  	rq->timeout = SD_WRITE_SAME_TIMEOUT;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
837
838
  
  	if (sdkp->ws16 || sector > 0xffffffff || nr_sectors > 0xffff) {
59b1134c5   Christoph Hellwig   sd: don't use scs...
839
840
841
842
  		cmd->cmd_len = 16;
  		cmd->cmnd[0] = WRITE_SAME_16;
  		put_unaligned_be64(sector, &cmd->cmnd[2]);
  		put_unaligned_be32(nr_sectors, &cmd->cmnd[10]);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
843
  	} else {
59b1134c5   Christoph Hellwig   sd: don't use scs...
844
845
846
847
  		cmd->cmd_len = 10;
  		cmd->cmnd[0] = WRITE_SAME;
  		put_unaligned_be32(sector, &cmd->cmnd[2]);
  		put_unaligned_be16(nr_sectors, &cmd->cmnd[7]);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
848
  	}
59b1134c5   Christoph Hellwig   sd: don't use scs...
849
  	cmd->transfersize = sdp->sector_size;
a25ee5485   Christoph Hellwig   sd: retry write s...
850
  	cmd->allowed = SD_MAX_RETRIES;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
851

59b1134c5   Christoph Hellwig   sd: don't use scs...
852
853
854
855
856
857
858
859
860
861
862
  	/*
  	 * For WRITE_SAME the data transferred in the DATA IN buffer is
  	 * different from the amount of data actually written to the target.
  	 *
  	 * We set up __data_len to the amount of data transferred from the
  	 * DATA IN buffer so that blk_rq_map_sg set up the proper S/G list
  	 * to transfer a single sector of data first, but then reset it to
  	 * the amount of data to be written right after so that the I/O path
  	 * knows how much to actually write.
  	 */
  	rq->__data_len = sdp->sector_size;
3c356bde1   Christoph Hellwig   scsi: stop passin...
863
  	ret = scsi_init_io(cmd);
59b1134c5   Christoph Hellwig   sd: don't use scs...
864
  	rq->__data_len = nr_bytes;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
865
866
  	return ret;
  }
a118c6c1d   Christoph Hellwig   sd: don't use scs...
867
  static int sd_setup_flush_cmnd(struct scsi_cmnd *cmd)
90467c294   FUJITA Tomonori   scsi: stop using ...
868
  {
a118c6c1d   Christoph Hellwig   sd: don't use scs...
869
870
871
872
  	struct request *rq = cmd->request;
  
  	/* flush requests don't perform I/O, zero the S/G table */
  	memset(&cmd->sdb, 0, sizeof(cmd->sdb));
90467c294   FUJITA Tomonori   scsi: stop using ...
873

a118c6c1d   Christoph Hellwig   sd: don't use scs...
874
875
876
877
  	cmd->cmnd[0] = SYNCHRONIZE_CACHE;
  	cmd->cmd_len = 10;
  	cmd->transfersize = 0;
  	cmd->allowed = SD_MAX_RETRIES;
26b9fd8b3   K. Y. Srinivasan   sd: fix a bug in ...
878
  	rq->timeout = rq->q->rq_timeout * SD_FLUSH_TIMEOUT_MULTIPLIER;
a118c6c1d   Christoph Hellwig   sd: don't use scs...
879
  	return BLKPREP_OK;
90467c294   FUJITA Tomonori   scsi: stop using ...
880
  }
87949eee7   Christoph Hellwig   sd: split sd_init...
881
  static int sd_setup_read_write_cmnd(struct scsi_cmnd *SCpnt)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
882
  {
a1b73fc19   Christoph Hellwig   scsi: reintroduce...
883
884
  	struct request *rq = SCpnt->request;
  	struct scsi_device *sdp = SCpnt->device;
776b23a03   Christoph Hellwig   [SCSI] always han...
885
  	struct gendisk *disk = rq->rq_disk;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
886
  	struct scsi_disk *sdkp;
83096ebf1   Tejun Heo   block: convert to...
887
  	sector_t block = blk_rq_pos(rq);
18351070b   Linus Torvalds   Re-introduce "[SC...
888
  	sector_t threshold;
83096ebf1   Tejun Heo   block: convert to...
889
  	unsigned int this_count = blk_rq_sectors(rq);
c611529e7   Martin K. Petersen   sd: Honor block l...
890
891
  	unsigned int dif, dix;
  	int ret;
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
892
  	unsigned char protect;
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
893

3c356bde1   Christoph Hellwig   scsi: stop passin...
894
  	ret = scsi_init_io(SCpnt);
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
895
896
897
  	if (ret != BLKPREP_OK)
  		goto out;
  	SCpnt = rq->special;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
898
  	sdkp = scsi_disk(disk);
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
899
900
901
902
  
  	/* from here on until we're complete, any goto out
  	 * is used for a killable error condition */
  	ret = BLKPREP_KILL;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
903

a1b73fc19   Christoph Hellwig   scsi: reintroduce...
904
905
906
907
908
  	SCSI_LOG_HLQUEUE(1,
  		scmd_printk(KERN_INFO, SCpnt,
  			"%s: block=%llu, count=%d
  ",
  			__func__, (unsigned long long)block, this_count));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
909
910
  
  	if (!sdp || !scsi_device_online(sdp) ||
83096ebf1   Tejun Heo   block: convert to...
911
  	    block + blk_rq_sectors(rq) > get_capacity(disk)) {
fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
912
  		SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
83096ebf1   Tejun Heo   block: convert to...
913
914
915
  						"Finishing %u sectors
  ",
  						blk_rq_sectors(rq)));
fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
916
917
918
  		SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
  						"Retry with 0x%p
  ", SCpnt));
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
919
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
920
921
922
923
924
925
926
  	}
  
  	if (sdp->changed) {
  		/*
  		 * quietly refuse to do anything to a changed disc until 
  		 * the changed bit has been reset
  		 */
3ff5588d3   Alan Stern   [SCSI] sd: improv...
927
928
  		/* printk("SCSI disk has been changed or is not present. Prohibiting further I/O.
  "); */
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
929
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
930
  	}
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
931

a0899d4df   Hans de Goede   [SCSI] sd: add fi...
932
  	/*
18351070b   Linus Torvalds   Re-introduce "[SC...
933
934
  	 * Some SD card readers can't handle multi-sector accesses which touch
  	 * the last one or two hardware sectors.  Split accesses as needed.
a0899d4df   Hans de Goede   [SCSI] sd: add fi...
935
  	 */
18351070b   Linus Torvalds   Re-introduce "[SC...
936
937
938
939
940
941
942
943
944
945
946
947
  	threshold = get_capacity(disk) - SD_LAST_BUGGY_SECTORS *
  		(sdp->sector_size / 512);
  
  	if (unlikely(sdp->last_sector_bug && block + this_count > threshold)) {
  		if (block < threshold) {
  			/* Access up to the threshold but not beyond */
  			this_count = threshold - block;
  		} else {
  			/* Access only a single hardware sector */
  			this_count = sdp->sector_size / 512;
  		}
  	}
a0899d4df   Hans de Goede   [SCSI] sd: add fi...
948

fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
949
950
951
  	SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt, "block=%llu
  ",
  					(unsigned long long)block));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
952
953
954
955
956
957
958
959
960
961
962
963
964
  
  	/*
  	 * If we have a 1K hardware sectorsize, prevent access to single
  	 * 512 byte sectors.  In theory we could handle this - in fact
  	 * the scsi cdrom driver must be able to handle this because
  	 * we typically use 1K blocksizes, and cdroms typically have
  	 * 2K hardware sectorsizes.  Of course, things are simpler
  	 * with the cdrom, since it is read-only.  For performance
  	 * reasons, the filesystems should be able to handle this
  	 * and not force the scsi disk driver to use bounce buffers
  	 * for this.
  	 */
  	if (sdp->sector_size == 1024) {
83096ebf1   Tejun Heo   block: convert to...
965
  		if ((block & 1) || (blk_rq_sectors(rq) & 1)) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
966
967
968
  			scmd_printk(KERN_ERR, SCpnt,
  				    "Bad block number requested
  ");
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
969
  			goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
970
971
972
973
974
975
  		} else {
  			block = block >> 1;
  			this_count = this_count >> 1;
  		}
  	}
  	if (sdp->sector_size == 2048) {
83096ebf1   Tejun Heo   block: convert to...
976
  		if ((block & 3) || (blk_rq_sectors(rq) & 3)) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
977
978
979
  			scmd_printk(KERN_ERR, SCpnt,
  				    "Bad block number requested
  ");
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
980
  			goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
981
982
983
984
985
986
  		} else {
  			block = block >> 2;
  			this_count = this_count >> 2;
  		}
  	}
  	if (sdp->sector_size == 4096) {
83096ebf1   Tejun Heo   block: convert to...
987
  		if ((block & 7) || (blk_rq_sectors(rq) & 7)) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
988
989
990
  			scmd_printk(KERN_ERR, SCpnt,
  				    "Bad block number requested
  ");
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
991
  			goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
992
993
994
995
996
997
  		} else {
  			block = block >> 3;
  			this_count = this_count >> 3;
  		}
  	}
  	if (rq_data_dir(rq) == WRITE) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
998
  		SCpnt->cmnd[0] = WRITE_6;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
999

8c579ab69   Martin K. Petersen   [SCSI] sd: Avoid ...
1000
  		if (blk_integrity_rq(rq))
c611529e7   Martin K. Petersen   sd: Honor block l...
1001
  			sd_dif_prepare(SCpnt);
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1002

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1003
1004
  	} else if (rq_data_dir(rq) == READ) {
  		SCpnt->cmnd[0] = READ_6;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1005
  	} else {
5953316db   Jens Axboe   block: make rq->c...
1006
1007
  		scmd_printk(KERN_ERR, SCpnt, "Unknown command %llx
  ", (unsigned long long) rq->cmd_flags);
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
1008
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1009
  	}
fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
1010
  	SCSI_LOG_HLQUEUE(2, scmd_printk(KERN_INFO, SCpnt,
83096ebf1   Tejun Heo   block: convert to...
1011
1012
  					"%s %d/%u 512 byte blocks.
  ",
fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
1013
1014
  					(rq_data_dir(rq) == WRITE) ?
  					"writing" : "reading", this_count,
83096ebf1   Tejun Heo   block: convert to...
1015
  					blk_rq_sectors(rq)));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1016

c611529e7   Martin K. Petersen   sd: Honor block l...
1017
1018
1019
1020
1021
  	dix = scsi_prot_sg_count(SCpnt);
  	dif = scsi_host_dif_capable(SCpnt->device->host, sdkp->protection_type);
  
  	if (dif || dix)
  		protect = sd_setup_protect_cmnd(SCpnt, dix, dif);
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1022
  	else
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
1023
  		protect = 0;
c611529e7   Martin K. Petersen   sd: Honor block l...
1024
  	if (protect && sdkp->protection_type == SD_DIF_TYPE2_PROTECTION) {
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
1025
1026
1027
1028
1029
1030
  		SCpnt->cmnd = mempool_alloc(sd_cdb_pool, GFP_ATOMIC);
  
  		if (unlikely(SCpnt->cmnd == NULL)) {
  			ret = BLKPREP_DEFER;
  			goto out;
  		}
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1031

4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
1032
1033
1034
1035
1036
  		SCpnt->cmd_len = SD_EXT_CDB_SIZE;
  		memset(SCpnt->cmnd, 0, SCpnt->cmd_len);
  		SCpnt->cmnd[0] = VARIABLE_LENGTH_CMD;
  		SCpnt->cmnd[7] = 0x18;
  		SCpnt->cmnd[9] = (rq_data_dir(rq) == READ) ? READ_32 : WRITE_32;
33659ebba   Christoph Hellwig   block: remove wra...
1037
  		SCpnt->cmnd[10] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
  
  		/* LBA */
  		SCpnt->cmnd[12] = sizeof(block) > 4 ? (unsigned char) (block >> 56) & 0xff : 0;
  		SCpnt->cmnd[13] = sizeof(block) > 4 ? (unsigned char) (block >> 48) & 0xff : 0;
  		SCpnt->cmnd[14] = sizeof(block) > 4 ? (unsigned char) (block >> 40) & 0xff : 0;
  		SCpnt->cmnd[15] = sizeof(block) > 4 ? (unsigned char) (block >> 32) & 0xff : 0;
  		SCpnt->cmnd[16] = (unsigned char) (block >> 24) & 0xff;
  		SCpnt->cmnd[17] = (unsigned char) (block >> 16) & 0xff;
  		SCpnt->cmnd[18] = (unsigned char) (block >> 8) & 0xff;
  		SCpnt->cmnd[19] = (unsigned char) block & 0xff;
  
  		/* Expected Indirect LBA */
  		SCpnt->cmnd[20] = (unsigned char) (block >> 24) & 0xff;
  		SCpnt->cmnd[21] = (unsigned char) (block >> 16) & 0xff;
  		SCpnt->cmnd[22] = (unsigned char) (block >> 8) & 0xff;
  		SCpnt->cmnd[23] = (unsigned char) block & 0xff;
  
  		/* Transfer length */
  		SCpnt->cmnd[28] = (unsigned char) (this_count >> 24) & 0xff;
  		SCpnt->cmnd[29] = (unsigned char) (this_count >> 16) & 0xff;
  		SCpnt->cmnd[30] = (unsigned char) (this_count >> 8) & 0xff;
  		SCpnt->cmnd[31] = (unsigned char) this_count & 0xff;
e430cbc8b   Akinobu Mita   sd: use READ_16 o...
1060
  	} else if (sdp->use_16_for_rw || (this_count > 0xffff)) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1061
  		SCpnt->cmnd[0] += READ_16 - READ_6;
33659ebba   Christoph Hellwig   block: remove wra...
1062
  		SCpnt->cmnd[1] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
  		SCpnt->cmnd[2] = sizeof(block) > 4 ? (unsigned char) (block >> 56) & 0xff : 0;
  		SCpnt->cmnd[3] = sizeof(block) > 4 ? (unsigned char) (block >> 48) & 0xff : 0;
  		SCpnt->cmnd[4] = sizeof(block) > 4 ? (unsigned char) (block >> 40) & 0xff : 0;
  		SCpnt->cmnd[5] = sizeof(block) > 4 ? (unsigned char) (block >> 32) & 0xff : 0;
  		SCpnt->cmnd[6] = (unsigned char) (block >> 24) & 0xff;
  		SCpnt->cmnd[7] = (unsigned char) (block >> 16) & 0xff;
  		SCpnt->cmnd[8] = (unsigned char) (block >> 8) & 0xff;
  		SCpnt->cmnd[9] = (unsigned char) block & 0xff;
  		SCpnt->cmnd[10] = (unsigned char) (this_count >> 24) & 0xff;
  		SCpnt->cmnd[11] = (unsigned char) (this_count >> 16) & 0xff;
  		SCpnt->cmnd[12] = (unsigned char) (this_count >> 8) & 0xff;
  		SCpnt->cmnd[13] = (unsigned char) this_count & 0xff;
  		SCpnt->cmnd[14] = SCpnt->cmnd[15] = 0;
  	} else if ((this_count > 0xff) || (block > 0x1fffff) ||
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1077
  		   scsi_device_protection(SCpnt->device) ||
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1078
  		   SCpnt->device->use_10_for_rw) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1079
  		SCpnt->cmnd[0] += READ_10 - READ_6;
33659ebba   Christoph Hellwig   block: remove wra...
1080
  		SCpnt->cmnd[1] = protect | ((rq->cmd_flags & REQ_FUA) ? 0x8 : 0);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1081
1082
1083
1084
1085
1086
1087
1088
  		SCpnt->cmnd[2] = (unsigned char) (block >> 24) & 0xff;
  		SCpnt->cmnd[3] = (unsigned char) (block >> 16) & 0xff;
  		SCpnt->cmnd[4] = (unsigned char) (block >> 8) & 0xff;
  		SCpnt->cmnd[5] = (unsigned char) block & 0xff;
  		SCpnt->cmnd[6] = SCpnt->cmnd[9] = 0;
  		SCpnt->cmnd[7] = (unsigned char) (this_count >> 8) & 0xff;
  		SCpnt->cmnd[8] = (unsigned char) this_count & 0xff;
  	} else {
33659ebba   Christoph Hellwig   block: remove wra...
1089
  		if (unlikely(rq->cmd_flags & REQ_FUA)) {
007365ad6   Tejun Heo   [BLOCK] scsi: add...
1090
1091
1092
1093
1094
1095
  			/*
  			 * This happens only if this drive failed
  			 * 10byte rw command with ILLEGAL_REQUEST
  			 * during operation and thus turned off
  			 * use_10_for_rw.
  			 */
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1096
1097
1098
  			scmd_printk(KERN_ERR, SCpnt,
  				    "FUA write on READ/WRITE(6) drive
  ");
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
1099
  			goto out;
007365ad6   Tejun Heo   [BLOCK] scsi: add...
1100
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1101
1102
1103
1104
1105
1106
  		SCpnt->cmnd[1] |= (unsigned char) ((block >> 16) & 0x1f);
  		SCpnt->cmnd[2] = (unsigned char) ((block >> 8) & 0xff);
  		SCpnt->cmnd[3] = (unsigned char) block & 0xff;
  		SCpnt->cmnd[4] = (unsigned char) this_count;
  		SCpnt->cmnd[5] = 0;
  	}
30b0c37b2   Boaz Harrosh   [SCSI] implement ...
1107
  	SCpnt->sdb.length = this_count * sdp->sector_size;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1108
1109
1110
1111
1112
1113
1114
1115
1116
  
  	/*
  	 * We shouldn't disconnect in the middle of a sector, so with a dumb
  	 * host adapter, it's safe to assume that we can at least transfer
  	 * this many bytes between each connect / disconnect.
  	 */
  	SCpnt->transfersize = sdp->sector_size;
  	SCpnt->underflow = this_count << 9;
  	SCpnt->allowed = SD_MAX_RETRIES;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1117
1118
  
  	/*
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1119
1120
1121
  	 * This indicates that the command is ready from our end to be
  	 * queued.
  	 */
7f9a6bc4e   James Bottomley   [SCSI] move ULD a...
1122
1123
  	ret = BLKPREP_OK;
   out:
a1b73fc19   Christoph Hellwig   scsi: reintroduce...
1124
  	return ret;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1125
  }
87949eee7   Christoph Hellwig   sd: split sd_init...
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
  static int sd_init_command(struct scsi_cmnd *cmd)
  {
  	struct request *rq = cmd->request;
  
  	if (rq->cmd_flags & REQ_DISCARD)
  		return sd_setup_discard_cmnd(cmd);
  	else if (rq->cmd_flags & REQ_WRITE_SAME)
  		return sd_setup_write_same_cmnd(cmd);
  	else if (rq->cmd_flags & REQ_FLUSH)
  		return sd_setup_flush_cmnd(cmd);
  	else
  		return sd_setup_read_write_cmnd(cmd);
  }
  
  static void sd_uninit_command(struct scsi_cmnd *SCpnt)
  {
  	struct request *rq = SCpnt->request;
  
  	if (rq->cmd_flags & REQ_DISCARD)
  		__free_page(rq->completion_data);
  
  	if (SCpnt->cmnd != rq->cmd) {
  		mempool_free(SCpnt->cmnd, sd_cdb_pool);
  		SCpnt->cmnd = NULL;
  		SCpnt->cmd_len = 0;
  	}
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
  /**
   *	sd_open - open a scsi disk device
   *	@inode: only i_rdev member may be used
   *	@filp: only f_mode and f_flags may be used
   *
   *	Returns 0 if successful. Returns a negated errno value in case 
   *	of error.
   *
   *	Note: This can be called from a user context (e.g. fsck(1) )
   *	or from within the kernel (e.g. as a result of a mount(1) ).
   *	In the latter case @inode and @filp carry an abridged amount
   *	of information as noted above.
409f3499a   Arnd Bergmann   scsi/sd: remove b...
1165
1166
   *
   *	Locking: called with bdev->bd_mutex held.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1167
   **/
0338e2917   Al Viro   [PATCH] switch sd
1168
  static int sd_open(struct block_device *bdev, fmode_t mode)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1169
  {
0338e2917   Al Viro   [PATCH] switch sd
1170
  	struct scsi_disk *sdkp = scsi_disk_get(bdev->bd_disk);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1171
1172
  	struct scsi_device *sdev;
  	int retval;
0338e2917   Al Viro   [PATCH] switch sd
1173
  	if (!sdkp)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1174
  		return -ENXIO;
fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
1175
1176
  	SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_open
  "));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
  
  	sdev = sdkp->device;
  
  	/*
  	 * If the device is in error recovery, wait until it is done.
  	 * If the device is offline, then disallow any access to it.
  	 */
  	retval = -ENXIO;
  	if (!scsi_block_when_processing_errors(sdev))
  		goto error_out;
  
  	if (sdev->removable || sdkp->write_prot)
0338e2917   Al Viro   [PATCH] switch sd
1189
  		check_disk_change(bdev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1190
1191
1192
1193
1194
  
  	/*
  	 * If the drive is empty, just let the open fail.
  	 */
  	retval = -ENOMEDIUM;
0338e2917   Al Viro   [PATCH] switch sd
1195
  	if (sdev->removable && !sdkp->media_present && !(mode & FMODE_NDELAY))
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1196
1197
1198
1199
1200
1201
1202
  		goto error_out;
  
  	/*
  	 * If the device has the write protect tab set, have the open fail
  	 * if the user expects to be able to write to the thing.
  	 */
  	retval = -EROFS;
0338e2917   Al Viro   [PATCH] switch sd
1203
  	if (sdkp->write_prot && (mode & FMODE_WRITE))
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
  		goto error_out;
  
  	/*
  	 * It is possible that the disk changing stuff resulted in
  	 * the device being taken offline.  If this is the case,
  	 * report this to the user, and don't pretend that the
  	 * open actually succeeded.
  	 */
  	retval = -ENXIO;
  	if (!scsi_device_online(sdev))
  		goto error_out;
409f3499a   Arnd Bergmann   scsi/sd: remove b...
1215
  	if ((atomic_inc_return(&sdkp->openers) == 1) && sdev->removable) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
  		if (scsi_block_when_processing_errors(sdev))
  			scsi_set_medium_removal(sdev, SCSI_REMOVAL_PREVENT);
  	}
  
  	return 0;
  
  error_out:
  	scsi_disk_put(sdkp);
  	return retval;	
  }
  
  /**
   *	sd_release - invoked when the (last) close(2) is called on this
   *	scsi disk.
   *	@inode: only i_rdev member may be used
   *	@filp: only f_mode and f_flags may be used
   *
   *	Returns 0. 
   *
   *	Note: may block (uninterruptible) if error recovery is underway
   *	on this disk.
409f3499a   Arnd Bergmann   scsi/sd: remove b...
1237
1238
   *
   *	Locking: called with bdev->bd_mutex held.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1239
   **/
db2a144be   Al Viro   block_device_oper...
1240
  static void sd_release(struct gendisk *disk, fmode_t mode)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1241
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1242
1243
  	struct scsi_disk *sdkp = scsi_disk(disk);
  	struct scsi_device *sdev = sdkp->device;
56937f7b7   James Bottomley   [SCSI] sd: typo f...
1244
1245
  	SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_release
  "));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1246

7e4433124   Alan Stern   [SCSI] sd: fix me...
1247
  	if (atomic_dec_return(&sdkp->openers) == 0 && sdev->removable) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1248
1249
1250
1251
1252
1253
1254
1255
  		if (scsi_block_when_processing_errors(sdev))
  			scsi_set_medium_removal(sdev, SCSI_REMOVAL_ALLOW);
  	}
  
  	/*
  	 * XXX and what if there are packets in flight and this close()
  	 * XXX is followed by a "rmmod sd_mod"?
  	 */
478a8a054   Alan Stern   [SCSI] sd: add su...
1256

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1257
  	scsi_disk_put(sdkp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1258
  }
a885c8c43   Christoph Hellwig   [PATCH] Add block...
1259
  static int sd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
  {
  	struct scsi_disk *sdkp = scsi_disk(bdev->bd_disk);
  	struct scsi_device *sdp = sdkp->device;
  	struct Scsi_Host *host = sdp->host;
  	int diskinfo[4];
  
  	/* default to most commonly used values */
          diskinfo[0] = 0x40;	/* 1 << 6 */
         	diskinfo[1] = 0x20;	/* 1 << 5 */
         	diskinfo[2] = sdkp->capacity >> 11;
  	
  	/* override with calculated, extended default, or driver values */
  	if (host->hostt->bios_param)
  		host->hostt->bios_param(sdp, bdev, sdkp->capacity, diskinfo);
  	else
  		scsicam_bios_param(bdev, sdkp->capacity, diskinfo);
a885c8c43   Christoph Hellwig   [PATCH] Add block...
1276
1277
1278
  	geo->heads = diskinfo[0];
  	geo->sectors = diskinfo[1];
  	geo->cylinders = diskinfo[2];
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289
  	return 0;
  }
  
  /**
   *	sd_ioctl - process an ioctl
   *	@inode: only i_rdev/i_bdev members may be used
   *	@filp: only f_mode and f_flags may be used
   *	@cmd: ioctl command number
   *	@arg: this is third argument given to ioctl(2) system call.
   *	Often contains a pointer.
   *
25985edce   Lucas De Marchi   Fix common misspe...
1290
   *	Returns 0 if successful (some ioctls return positive numbers on
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1291
1292
1293
   *	success as well). Returns a negated errno value in case of error.
   *
   *	Note: most ioctls are forward onto the block subsystem or further
3a4fa0a25   Robert P. J. Day   Fix misspellings ...
1294
   *	down in the scsi subsystem.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1295
   **/
0338e2917   Al Viro   [PATCH] switch sd
1296
  static int sd_ioctl(struct block_device *bdev, fmode_t mode,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1297
1298
  		    unsigned int cmd, unsigned long arg)
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1299
  	struct gendisk *disk = bdev->bd_disk;
fe2d1851e   Nao Nishijima   [SCSI] sd: Use sd...
1300
1301
  	struct scsi_disk *sdkp = scsi_disk(disk);
  	struct scsi_device *sdp = sdkp->device;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1302
1303
1304
  	void __user *p = (void __user *)arg;
  	int error;
      
fe2d1851e   Nao Nishijima   [SCSI] sd: Use sd...
1305
1306
1307
  	SCSI_LOG_IOCTL(1, sd_printk(KERN_INFO, sdkp, "sd_ioctl: disk=%s, "
  				    "cmd=0x%x
  ", disk->disk_name, cmd));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1308

0bfc96cb7   Paolo Bonzini   block: fail SCSI ...
1309
1310
1311
  	error = scsi_verify_blk_ioctl(bdev, cmd);
  	if (error < 0)
  		return error;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1312
1313
1314
1315
1316
1317
  	/*
  	 * If we are in the middle of error recovery, don't let anyone
  	 * else try and use this device.  Also, if error recovery fails, it
  	 * may try and take the device offline, in which case all further
  	 * access to the device is prohibited.
  	 */
906d15fbd   Christoph Hellwig   scsi: split scsi_...
1318
1319
1320
  	error = scsi_ioctl_block_when_processing_errors(sdp, cmd,
  			(mode & FMODE_NDELAY) != 0);
  	if (error)
8a6cfeb6d   Arnd Bergmann   block: push down ...
1321
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1322

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1323
1324
1325
1326
1327
1328
1329
1330
  	/*
  	 * Send SCSI addressing ioctls directly to mid level, send other
  	 * ioctls to block level and then onto mid level if they can't be
  	 * resolved.
  	 */
  	switch (cmd) {
  		case SCSI_IOCTL_GET_IDLUN:
  		case SCSI_IOCTL_GET_BUS_NUMBER:
8a6cfeb6d   Arnd Bergmann   block: push down ...
1331
1332
  			error = scsi_ioctl(sdp, cmd, p);
  			break;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1333
  		default:
577ebb374   Paolo Bonzini   block: add and us...
1334
  			error = scsi_cmd_blk_ioctl(bdev, mode, cmd, p);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1335
  			if (error != -ENOTTY)
8a6cfeb6d   Arnd Bergmann   block: push down ...
1336
1337
1338
  				break;
  			error = scsi_ioctl(sdp, cmd, p);
  			break;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1339
  	}
8a6cfeb6d   Arnd Bergmann   block: push down ...
1340
  out:
8a6cfeb6d   Arnd Bergmann   block: push down ...
1341
  	return error;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1342
1343
1344
1345
  }
  
  static void set_media_not_present(struct scsi_disk *sdkp)
  {
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1346
1347
1348
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359
1360
1361
1362
1363
1364
1365
1366
1367
1368
1369
1370
1371
  	if (sdkp->media_present)
  		sdkp->device->changed = 1;
  
  	if (sdkp->device->removable) {
  		sdkp->media_present = 0;
  		sdkp->capacity = 0;
  	}
  }
  
  static int media_not_present(struct scsi_disk *sdkp,
  			     struct scsi_sense_hdr *sshdr)
  {
  	if (!scsi_sense_valid(sshdr))
  		return 0;
  
  	/* not invoked for commands that could return deferred errors */
  	switch (sshdr->sense_key) {
  	case UNIT_ATTENTION:
  	case NOT_READY:
  		/* medium not present */
  		if (sshdr->asc == 0x3A) {
  			set_media_not_present(sdkp);
  			return 1;
  		}
  	}
  	return 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1372
1373
1374
  }
  
  /**
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1375
1376
1377
   *	sd_check_events - check media events
   *	@disk: kernel device descriptor
   *	@clearing: disk events currently being cleared
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1378
   *
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1379
   *	Returns mask of DISK_EVENT_*.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1380
1381
1382
   *
   *	Note: this function is invoked from the block subsystem.
   **/
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1383
  static unsigned int sd_check_events(struct gendisk *disk, unsigned int clearing)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1384
1385
1386
  {
  	struct scsi_disk *sdkp = scsi_disk(disk);
  	struct scsi_device *sdp = sdkp->device;
001aac257   James Bottomley   [SCSI] sd,sr: add...
1387
  	struct scsi_sense_hdr *sshdr = NULL;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1388
  	int retval;
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1389
1390
  	SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp, "sd_check_events
  "));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1391
1392
1393
1394
1395
1396
1397
  
  	/*
  	 * If the device is offline, don't send any commands - just pretend as
  	 * if the command failed.  If the device ever comes back online, we
  	 * can deal with it then.  It is only because of unrecoverable errors
  	 * that we would ever take a device offline in the first place.
  	 */
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1398
1399
  	if (!scsi_device_online(sdp)) {
  		set_media_not_present(sdkp);
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1400
1401
  		goto out;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411
1412
  
  	/*
  	 * Using TEST_UNIT_READY enables differentiation between drive with
  	 * no cartridge loaded - NOT READY, drive with changed cartridge -
  	 * UNIT ATTENTION, or with same cartridge - GOOD STATUS.
  	 *
  	 * Drives that auto spin down. eg iomega jaz 1G, will be started
  	 * by sd_spinup_disk() from sd_revalidate_disk(), which happens whenever
  	 * sd_revalidate() is called.
  	 */
  	retval = -ENODEV;
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1413

001aac257   James Bottomley   [SCSI] sd,sr: add...
1414
1415
1416
1417
1418
  	if (scsi_block_when_processing_errors(sdp)) {
  		sshdr  = kzalloc(sizeof(*sshdr), GFP_KERNEL);
  		retval = scsi_test_unit_ready(sdp, SD_TIMEOUT, SD_MAX_RETRIES,
  					      sshdr);
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1419

2bae0093c   Tejun Heo   [SCSI] sd: implem...
1420
1421
  	/* failed to execute TUR, assume media not present */
  	if (host_byte(retval)) {
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1422
  		set_media_not_present(sdkp);
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1423
1424
  		goto out;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1425

2bae0093c   Tejun Heo   [SCSI] sd: implem...
1426
1427
  	if (media_not_present(sdkp, sshdr))
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1428
1429
  	/*
  	 * For removable scsi disk we have to recognise the presence
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1430
  	 * of a disk in the drive.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1431
  	 */
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1432
1433
  	if (!sdkp->media_present)
  		sdp->changed = 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1434
  	sdkp->media_present = 1;
285e9670d   Kay Sievers   [SCSI] sr,sd: sen...
1435
  out:
3ff5588d3   Alan Stern   [SCSI] sd: improv...
1436
  	/*
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1437
  	 * sdp->changed is set under the following conditions:
3ff5588d3   Alan Stern   [SCSI] sd: improv...
1438
  	 *
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1439
1440
  	 *	Medium present state has changed in either direction.
  	 *	Device has indicated UNIT_ATTENTION.
3ff5588d3   Alan Stern   [SCSI] sd: improv...
1441
  	 */
001aac257   James Bottomley   [SCSI] sd,sr: add...
1442
  	kfree(sshdr);
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1443
1444
  	retval = sdp->changed ? DISK_EVENT_MEDIA_CHANGE : 0;
  	sdp->changed = 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1445
  	return retval;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1446
  }
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1447
  static int sd_sync_cache(struct scsi_disk *sdkp)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1448
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1449
  	int retries, res;
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1450
  	struct scsi_device *sdp = sdkp->device;
7e660100d   James Bottomley   [SCSI] Derive the...
1451
1452
  	const int timeout = sdp->request_queue->rq_timeout
  		* SD_FLUSH_TIMEOUT_MULTIPLIER;
ea73a9f23   James Bottomley   [SCSI] convert sd...
1453
  	struct scsi_sense_hdr sshdr;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1454
1455
1456
  
  	if (!scsi_device_online(sdp))
  		return -ENODEV;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1457
1458
1459
1460
1461
1462
1463
1464
  	for (retries = 3; retries > 0; --retries) {
  		unsigned char cmd[10] = { 0 };
  
  		cmd[0] = SYNCHRONIZE_CACHE;
  		/*
  		 * Leave the rest of the command zero to indicate
  		 * flush everything.
  		 */
9b21493c4   Lin Ming   [SCSI] sd: use RE...
1465
  		res = scsi_execute_req_flags(sdp, cmd, DMA_NONE, NULL, 0,
7e660100d   James Bottomley   [SCSI] Derive the...
1466
1467
  					     &sshdr, timeout, SD_MAX_RETRIES,
  					     NULL, REQ_PM);
ea73a9f23   James Bottomley   [SCSI] convert sd...
1468
  		if (res == 0)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1469
1470
  			break;
  	}
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1471
  	if (res) {
ef61329db   Hannes Reinecke   scsi: remove scsi...
1472
  		sd_print_result(sdkp, "Synchronize Cache(10) failed", res);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
1473

e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1474
1475
  		if (driver_byte(res) & DRIVER_SENSE)
  			sd_print_sense_hdr(sdkp, &sshdr);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
1476
1477
  		/* we need to evaluate the error return  */
  		if (scsi_sense_valid(&sshdr) &&
7aae51347   Alan Stern   [SCSI] sd: don't ...
1478
1479
  			(sshdr.asc == 0x3a ||	/* medium not present */
  			 sshdr.asc == 0x20))	/* invalid command */
95897910a   Oliver Neukum   [SCSI] sd: Add er...
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
  				/* this is no error here */
  				return 0;
  
  		switch (host_byte(res)) {
  		/* ignore errors due to racing a disconnection */
  		case DID_BAD_TARGET:
  		case DID_NO_CONNECT:
  			return 0;
  		/* signal the upper layer it might try again */
  		case DID_BUS_BUSY:
  		case DID_IMM_RETRY:
  		case DID_REQUEUE:
  		case DID_SOFT_ERROR:
  			return -EBUSY;
  		default:
  			return -EIO;
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1497
  	}
3721050af   Tejun Heo   [SCSI] sd: fix re...
1498
  	return 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1499
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1500
1501
  static void sd_rescan(struct device *dev)
  {
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
1502
  	struct scsi_disk *sdkp = dev_get_drvdata(dev);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
1503

3d9a1f530   Christoph Hellwig   sd: don't grab a ...
1504
  	revalidate_disk(sdkp->disk);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1505
1506
1507
1508
1509
1510
1511
1512
  }
  
  
  #ifdef CONFIG_COMPAT
  /* 
   * This gets directly called from VFS. When the ioctl 
   * is not recognized we go back to the other translation paths. 
   */
0338e2917   Al Viro   [PATCH] switch sd
1513
1514
  static int sd_compat_ioctl(struct block_device *bdev, fmode_t mode,
  			   unsigned int cmd, unsigned long arg)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1515
  {
0338e2917   Al Viro   [PATCH] switch sd
1516
  	struct scsi_device *sdev = scsi_disk(bdev->bd_disk)->device;
21a9d4c9d   Christoph Hellwig   sd: fix up ->comp...
1517
  	int error;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1518

21a9d4c9d   Christoph Hellwig   sd: fix up ->comp...
1519
1520
1521
1522
  	error = scsi_ioctl_block_when_processing_errors(sdev, cmd,
  			(mode & FMODE_NDELAY) != 0);
  	if (error)
  		return error;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1523
  	       
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1524
1525
1526
  	/* 
  	 * Let the static ioctl translation table take care of it.
  	 */
21a9d4c9d   Christoph Hellwig   sd: fix up ->comp...
1527
1528
1529
  	if (!sdev->host->hostt->compat_ioctl)
  		return -ENOIOCTLCMD; 
  	return sdev->host->hostt->compat_ioctl(sdev, cmd, (void __user *)arg);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1530
1531
  }
  #endif
924d55b06   Christoph Hellwig   sd: implement the...
1532
1533
1534
1535
1536
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610
1611
1612
1613
1614
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624
1625
  static char sd_pr_type(enum pr_type type)
  {
  	switch (type) {
  	case PR_WRITE_EXCLUSIVE:
  		return 0x01;
  	case PR_EXCLUSIVE_ACCESS:
  		return 0x03;
  	case PR_WRITE_EXCLUSIVE_REG_ONLY:
  		return 0x05;
  	case PR_EXCLUSIVE_ACCESS_REG_ONLY:
  		return 0x06;
  	case PR_WRITE_EXCLUSIVE_ALL_REGS:
  		return 0x07;
  	case PR_EXCLUSIVE_ACCESS_ALL_REGS:
  		return 0x08;
  	default:
  		return 0;
  	}
  };
  
  static int sd_pr_command(struct block_device *bdev, u8 sa,
  		u64 key, u64 sa_key, u8 type, u8 flags)
  {
  	struct scsi_device *sdev = scsi_disk(bdev->bd_disk)->device;
  	struct scsi_sense_hdr sshdr;
  	int result;
  	u8 cmd[16] = { 0, };
  	u8 data[24] = { 0, };
  
  	cmd[0] = PERSISTENT_RESERVE_OUT;
  	cmd[1] = sa;
  	cmd[2] = type;
  	put_unaligned_be32(sizeof(data), &cmd[5]);
  
  	put_unaligned_be64(key, &data[0]);
  	put_unaligned_be64(sa_key, &data[8]);
  	data[20] = flags;
  
  	result = scsi_execute_req(sdev, cmd, DMA_TO_DEVICE, &data, sizeof(data),
  			&sshdr, SD_TIMEOUT, SD_MAX_RETRIES, NULL);
  
  	if ((driver_byte(result) & DRIVER_SENSE) &&
  	    (scsi_sense_valid(&sshdr))) {
  		sdev_printk(KERN_INFO, sdev, "PR command failed: %d
  ", result);
  		scsi_print_sense_hdr(sdev, NULL, &sshdr);
  	}
  
  	return result;
  }
  
  static int sd_pr_register(struct block_device *bdev, u64 old_key, u64 new_key,
  		u32 flags)
  {
  	if (flags & ~PR_FL_IGNORE_KEY)
  		return -EOPNOTSUPP;
  	return sd_pr_command(bdev, (flags & PR_FL_IGNORE_KEY) ? 0x06 : 0x00,
  			old_key, new_key, 0,
  			(1 << 0) /* APTPL */ |
  			(1 << 2) /* ALL_TG_PT */);
  }
  
  static int sd_pr_reserve(struct block_device *bdev, u64 key, enum pr_type type,
  		u32 flags)
  {
  	if (flags)
  		return -EOPNOTSUPP;
  	return sd_pr_command(bdev, 0x01, key, 0, sd_pr_type(type), 0);
  }
  
  static int sd_pr_release(struct block_device *bdev, u64 key, enum pr_type type)
  {
  	return sd_pr_command(bdev, 0x02, key, 0, sd_pr_type(type), 0);
  }
  
  static int sd_pr_preempt(struct block_device *bdev, u64 old_key, u64 new_key,
  		enum pr_type type, bool abort)
  {
  	return sd_pr_command(bdev, abort ? 0x05 : 0x04, old_key, new_key,
  			     sd_pr_type(type), 0);
  }
  
  static int sd_pr_clear(struct block_device *bdev, u64 key)
  {
  	return sd_pr_command(bdev, 0x03, key, 0, 0, 0);
  }
  
  static const struct pr_ops sd_pr_ops = {
  	.pr_register	= sd_pr_register,
  	.pr_reserve	= sd_pr_reserve,
  	.pr_release	= sd_pr_release,
  	.pr_preempt	= sd_pr_preempt,
  	.pr_clear	= sd_pr_clear,
  };
83d5cde47   Alexey Dobriyan   const: make block...
1626
  static const struct block_device_operations sd_fops = {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1627
  	.owner			= THIS_MODULE,
0338e2917   Al Viro   [PATCH] switch sd
1628
1629
  	.open			= sd_open,
  	.release		= sd_release,
8a6cfeb6d   Arnd Bergmann   block: push down ...
1630
  	.ioctl			= sd_ioctl,
a885c8c43   Christoph Hellwig   [PATCH] Add block...
1631
  	.getgeo			= sd_getgeo,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1632
  #ifdef CONFIG_COMPAT
0338e2917   Al Viro   [PATCH] switch sd
1633
  	.compat_ioctl		= sd_compat_ioctl,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1634
  #endif
2bae0093c   Tejun Heo   [SCSI] sd: implem...
1635
  	.check_events		= sd_check_events,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1636
  	.revalidate_disk	= sd_revalidate_disk,
72ec24bd7   Tejun Heo   SCSI: implement s...
1637
  	.unlock_native_capacity	= sd_unlock_native_capacity,
924d55b06   Christoph Hellwig   sd: implement the...
1638
  	.pr_ops			= &sd_pr_ops,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1639
  };
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1640
1641
1642
  /**
   *	sd_eh_action - error handling callback
   *	@scmd:		sd-issued command that has failed
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1643
1644
   *	@eh_disp:	The recovery disposition suggested by the midlayer
   *
2451079bc   James Bottomley   [SCSI] Fix errati...
1645
1646
1647
1648
1649
1650
   *	This function is called by the SCSI midlayer upon completion of an
   *	error test command (currently TEST UNIT READY). The result of sending
   *	the eh command is passed in eh_disp.  We're looking for devices that
   *	fail medium access commands but are OK with non access commands like
   *	test unit ready (so wrongly see the device as having a successful
   *	recovery)
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1651
   **/
2451079bc   James Bottomley   [SCSI] Fix errati...
1652
  static int sd_eh_action(struct scsi_cmnd *scmd, int eh_disp)
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1653
1654
1655
1656
  {
  	struct scsi_disk *sdkp = scsi_disk(scmd->request->rq_disk);
  
  	if (!scsi_device_online(scmd->device) ||
2451079bc   James Bottomley   [SCSI] Fix errati...
1657
1658
1659
  	    !scsi_medium_access_command(scmd) ||
  	    host_byte(scmd->result) != DID_TIME_OUT ||
  	    eh_disp != SUCCESS)
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1660
1661
1662
1663
1664
1665
1666
1667
1668
  		return eh_disp;
  
  	/*
  	 * The device has timed out executing a medium access command.
  	 * However, the TEST UNIT READY command sent during error
  	 * handling completed successfully. Either the device is in the
  	 * process of recovering or has it suffered an internal failure
  	 * that prevents access to the storage medium.
  	 */
2451079bc   James Bottomley   [SCSI] Fix errati...
1669
  	sdkp->medium_access_timed_out++;
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
1670
1671
1672
1673
1674
1675
1676
1677
1678
1679
1680
1681
1682
1683
1684
1685
1686
  
  	/*
  	 * If the device keeps failing read/write commands but TEST UNIT
  	 * READY always completes successfully we assume that medium
  	 * access is no longer possible and take the device offline.
  	 */
  	if (sdkp->medium_access_timed_out >= sdkp->max_medium_access_timeouts) {
  		scmd_printk(KERN_ERR, scmd,
  			    "Medium access timeout failure. Offlining disk!
  ");
  		scsi_device_set_state(scmd->device, SDEV_OFFLINE);
  
  		return FAILED;
  	}
  
  	return eh_disp;
  }
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1687
1688
  static unsigned int sd_completed_bytes(struct scsi_cmnd *scmd)
  {
83096ebf1   Tejun Heo   block: convert to...
1689
1690
  	u64 start_lba = blk_rq_pos(scmd->request);
  	u64 end_lba = blk_rq_pos(scmd->request) + (scsi_bufflen(scmd) / 512);
74856fbf4   Mark Hounschell   sd: Disable suppo...
1691
  	u64 factor = scmd->device->sector_size / 512;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1692
1693
  	u64 bad_lba;
  	int info_valid;
a8733c7ba   James Bottomley   [SCSI] fix medium...
1694
1695
1696
1697
1698
1699
  	/*
  	 * resid is optional but mostly filled in.  When it's unused,
  	 * its value is zero, so we assume the whole buffer transferred
  	 */
  	unsigned int transferred = scsi_bufflen(scmd) - scsi_get_resid(scmd);
  	unsigned int good_bytes;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1700

33659ebba   Christoph Hellwig   block: remove wra...
1701
  	if (scmd->request->cmd_type != REQ_TYPE_FS)
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1702
1703
1704
1705
1706
1707
1708
1709
1710
1711
  		return 0;
  
  	info_valid = scsi_get_sense_info_fld(scmd->sense_buffer,
  					     SCSI_SENSE_BUFFERSIZE,
  					     &bad_lba);
  	if (!info_valid)
  		return 0;
  
  	if (scsi_bufflen(scmd) <= scmd->device->sector_size)
  		return 0;
74856fbf4   Mark Hounschell   sd: Disable suppo...
1712
1713
1714
  	/* be careful ... don't want any overflows */
  	do_div(start_lba, factor);
  	do_div(end_lba, factor);
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1715
1716
1717
1718
1719
1720
1721
1722
1723
1724
  
  	/* The bad lba was reported incorrectly, we have no idea where
  	 * the error is.
  	 */
  	if (bad_lba < start_lba  || bad_lba >= end_lba)
  		return 0;
  
  	/* This computation should always be done in terms of
  	 * the resolution of the device's medium.
  	 */
a8733c7ba   James Bottomley   [SCSI] fix medium...
1725
1726
  	good_bytes = (bad_lba - start_lba) * scmd->device->sector_size;
  	return min(good_bytes, transferred);
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1727
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1728
  /**
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
1729
   *	sd_done - bottom half handler: called when the lower level
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1730
1731
1732
1733
1734
   *	driver has completed (successfully or otherwise) a scsi command.
   *	@SCpnt: mid-level's per command structure.
   *
   *	Note: potentially run from within an ISR. Must not block.
   **/
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
1735
  static int sd_done(struct scsi_cmnd *SCpnt)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1736
1737
  {
  	int result = SCpnt->result;
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1738
  	unsigned int good_bytes = result ? 0 : scsi_bufflen(SCpnt);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1739
  	struct scsi_sense_hdr sshdr;
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
1740
  	struct scsi_disk *sdkp = scsi_disk(SCpnt->request->rq_disk);
26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
1741
  	struct request *req = SCpnt->request;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1742
1743
  	int sense_valid = 0;
  	int sense_deferred = 0;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
1744
  	unsigned char op = SCpnt->cmnd[0];
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
1745
  	unsigned char unmap = SCpnt->cmnd[1] & 8;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1746

5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
1747
  	if (req->cmd_flags & REQ_DISCARD || req->cmd_flags & REQ_WRITE_SAME) {
26e85fcd1   Martin K. Petersen   [SCSI] sd: Permit...
1748
1749
1750
1751
1752
1753
1754
1755
  		if (!result) {
  			good_bytes = blk_rq_bytes(req);
  			scsi_set_resid(SCpnt, 0);
  		} else {
  			good_bytes = 0;
  			scsi_set_resid(SCpnt, blk_rq_bytes(req));
  		}
  	}
6a32a8aed   FUJITA Tomonori   scsi: convert dis...
1756

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1757
1758
1759
1760
1761
  	if (result) {
  		sense_valid = scsi_command_normalize_sense(SCpnt, &sshdr);
  		if (sense_valid)
  			sense_deferred = scsi_sense_is_deferred(&sshdr);
  	}
2a863ba8f   David Jeffery   sd: medium access...
1762
  	sdkp->medium_access_timed_out = 0;
03aba2f79   Luben Tuikov   [SCSI] sd/scsi_li...
1763
1764
1765
1766
1767
1768
1769
  	if (driver_byte(result) != DRIVER_SENSE &&
  	    (!sense_valid || sense_deferred))
  		goto out;
  
  	switch (sshdr.sense_key) {
  	case HARDWARE_ERROR:
  	case MEDIUM_ERROR:
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1770
  		good_bytes = sd_completed_bytes(SCpnt);
03aba2f79   Luben Tuikov   [SCSI] sd/scsi_li...
1771
1772
  		break;
  	case RECOVERED_ERROR:
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1773
1774
  		good_bytes = scsi_bufflen(SCpnt);
  		break;
10dab2266   Jamie Wellnitz   [SCSI] sd: Fix ha...
1775
1776
1777
1778
1779
  	case NO_SENSE:
  		/* This indicates a false check condition, so ignore it.  An
  		 * unknown amount of data was transferred so treat it as an
  		 * error.
  		 */
10dab2266   Jamie Wellnitz   [SCSI] sd: Fix ha...
1780
1781
1782
  		SCpnt->result = 0;
  		memset(SCpnt->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
  		break;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
1783
1784
1785
1786
1787
1788
  	case ABORTED_COMMAND:
  		if (sshdr.asc == 0x10)  /* DIF: Target detected corruption */
  			good_bytes = sd_completed_bytes(SCpnt);
  		break;
  	case ILLEGAL_REQUEST:
  		if (sshdr.asc == 0x10)  /* DIX: Host detected corruption */
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1789
  			good_bytes = sd_completed_bytes(SCpnt);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
1790
  		/* INVALID COMMAND OPCODE or INVALID FIELD IN CDB */
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
1791
1792
1793
1794
1795
1796
1797
1798
1799
1800
1801
1802
1803
1804
1805
1806
1807
1808
1809
  		if (sshdr.asc == 0x20 || sshdr.asc == 0x24) {
  			switch (op) {
  			case UNMAP:
  				sd_config_discard(sdkp, SD_LBP_DISABLE);
  				break;
  			case WRITE_SAME_16:
  			case WRITE_SAME:
  				if (unmap)
  					sd_config_discard(sdkp, SD_LBP_DISABLE);
  				else {
  					sdkp->device->no_write_same = 1;
  					sd_config_write_same(sdkp);
  
  					good_bytes = 0;
  					req->__data_len = blk_rq_bytes(req);
  					req->cmd_flags |= REQ_QUIET;
  				}
  			}
  		}
03aba2f79   Luben Tuikov   [SCSI] sd/scsi_li...
1810
1811
1812
  		break;
  	default:
  		break;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1813
  	}
03aba2f79   Luben Tuikov   [SCSI] sd/scsi_li...
1814
   out:
ef61329db   Hannes Reinecke   scsi: remove scsi...
1815
1816
1817
1818
  	SCSI_LOG_HLCOMPLETE(1, scmd_printk(KERN_INFO, SCpnt,
  					   "sd_done: completed %d of %d bytes
  ",
  					   good_bytes, scsi_bufflen(SCpnt)));
af55ff675   Martin K. Petersen   [SCSI] sd: Suppor...
1819
1820
  	if (rq_data_dir(SCpnt->request) == READ && scsi_prot_sg_count(SCpnt))
  		sd_dif_complete(SCpnt, good_bytes);
7b3d9545f   Linus Torvalds   Revert "scsi: rev...
1821
  	return good_bytes;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1822
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1823
1824
1825
1826
  /*
   * spinup disk - called only in sd_revalidate_disk()
   */
  static void
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1827
  sd_spinup_disk(struct scsi_disk *sdkp)
ea73a9f23   James Bottomley   [SCSI] convert sd...
1828
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1829
  	unsigned char cmd[10];
4451e4726   Alan Stern   [SCSI] sd: pause ...
1830
  	unsigned long spintime_expire = 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1831
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843
1844
1845
  	int retries, spintime;
  	unsigned int the_result;
  	struct scsi_sense_hdr sshdr;
  	int sense_valid = 0;
  
  	spintime = 0;
  
  	/* Spin up drives, as required.  Only do this at boot time */
  	/* Spinup needs to be done for module loads too. */
  	do {
  		retries = 0;
  
  		do {
  			cmd[0] = TEST_UNIT_READY;
  			memset((void *) &cmd[1], 0, 9);
ea73a9f23   James Bottomley   [SCSI] convert sd...
1846
1847
1848
  			the_result = scsi_execute_req(sdkp->device, cmd,
  						      DMA_NONE, NULL, 0,
  						      &sshdr, SD_TIMEOUT,
f4f4e47e4   FUJITA Tomonori   [SCSI] add residu...
1849
  						      SD_MAX_RETRIES, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1850

b4d38e38e   Alan Stern   [SCSI] Reduce pol...
1851
1852
1853
1854
1855
1856
1857
  			/*
  			 * If the drive has indicated to us that it
  			 * doesn't have any media in it, don't bother
  			 * with any more polling.
  			 */
  			if (media_not_present(sdkp, &sshdr))
  				return;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1858
  			if (the_result)
ea73a9f23   James Bottomley   [SCSI] convert sd...
1859
  				sense_valid = scsi_sense_valid(&sshdr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1860
1861
1862
1863
1864
  			retries++;
  		} while (retries < 3 && 
  			 (!scsi_status_is_good(the_result) ||
  			  ((driver_byte(the_result) & DRIVER_SENSE) &&
  			  sense_valid && sshdr.sense_key == UNIT_ATTENTION)));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1865
1866
1867
  		if ((driver_byte(the_result) & DRIVER_SENSE) == 0) {
  			/* no sense, TUR either succeeded or failed
  			 * with a status error */
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1868
  			if(!spintime && !scsi_status_is_good(the_result)) {
ef61329db   Hannes Reinecke   scsi: remove scsi...
1869
1870
  				sd_print_result(sdkp, "Test Unit Ready failed",
  						the_result);
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1871
  			}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1872
1873
  			break;
  		}
ef61329db   Hannes Reinecke   scsi: remove scsi...
1874

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1875
1876
1877
  		/*
  		 * The device does not want the automatic start to be issued.
  		 */
33dd6f92a   Matthew Wilcox   [SCSI] sd: Don't ...
1878
  		if (sdkp->device->no_start_on_add)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1879
  			break;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1880

33dd6f92a   Matthew Wilcox   [SCSI] sd: Don't ...
1881
1882
1883
1884
1885
1886
1887
1888
1889
1890
  		if (sense_valid && sshdr.sense_key == NOT_READY) {
  			if (sshdr.asc == 4 && sshdr.ascq == 3)
  				break;	/* manual intervention required */
  			if (sshdr.asc == 4 && sshdr.ascq == 0xb)
  				break;	/* standby */
  			if (sshdr.asc == 4 && sshdr.ascq == 0xc)
  				break;	/* unavailable */
  			/*
  			 * Issue command to spin up drive when not ready
  			 */
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1891
  			if (!spintime) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1892
  				sd_printk(KERN_NOTICE, sdkp, "Spinning up disk...");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1893
1894
1895
1896
  				cmd[0] = START_STOP;
  				cmd[1] = 1;	/* Return immediately */
  				memset((void *) &cmd[2], 0, 8);
  				cmd[4] = 1;	/* Start spin cycle */
d2886ea36   Stefan Richter   scsi: sd: optiona...
1897
1898
  				if (sdkp->device->start_stop_pwr_cond)
  					cmd[4] |= 1 << 4;
ea73a9f23   James Bottomley   [SCSI] convert sd...
1899
1900
  				scsi_execute_req(sdkp->device, cmd, DMA_NONE,
  						 NULL, 0, &sshdr,
f4f4e47e4   FUJITA Tomonori   [SCSI] add residu...
1901
1902
  						 SD_TIMEOUT, SD_MAX_RETRIES,
  						 NULL);
4451e4726   Alan Stern   [SCSI] sd: pause ...
1903
1904
  				spintime_expire = jiffies + 100 * HZ;
  				spintime = 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1905
  			}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1906
1907
1908
  			/* Wait 1 second for next try */
  			msleep(1000);
  			printk(".");
4451e4726   Alan Stern   [SCSI] sd: pause ...
1909
1910
1911
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
  
  		/*
  		 * Wait for USB flash devices with slow firmware.
  		 * Yes, this sense key/ASC combination shouldn't
  		 * occur here.  It's characteristic of these devices.
  		 */
  		} else if (sense_valid &&
  				sshdr.sense_key == UNIT_ATTENTION &&
  				sshdr.asc == 0x28) {
  			if (!spintime) {
  				spintime_expire = jiffies + 5 * HZ;
  				spintime = 1;
  			}
  			/* Wait 1 second for next try */
  			msleep(1000);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1924
1925
1926
1927
  		} else {
  			/* we don't understand the sense code, so it's
  			 * probably pointless to loop */
  			if(!spintime) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
1928
1929
1930
  				sd_printk(KERN_NOTICE, sdkp, "Unit Not Ready
  ");
  				sd_print_sense_hdr(sdkp, &sshdr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1931
1932
1933
1934
  			}
  			break;
  		}
  				
4451e4726   Alan Stern   [SCSI] sd: pause ...
1935
  	} while (spintime && time_before_eq(jiffies, spintime_expire));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1936
1937
1938
1939
1940
1941
1942
1943
1944
1945
  
  	if (spintime) {
  		if (scsi_status_is_good(the_result))
  			printk("ready
  ");
  		else
  			printk("not responding...
  ");
  	}
  }
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
1946
1947
1948
1949
  
  /*
   * Determine whether disk supports Data Integrity Field.
   */
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
1950
  static int sd_read_protection_type(struct scsi_disk *sdkp, unsigned char *buffer)
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
1951
1952
1953
  {
  	struct scsi_device *sdp = sdkp->device;
  	u8 type;
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
1954
  	int ret = 0;
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
1955
1956
  
  	if (scsi_device_protection(sdp) == 0 || (buffer[12] & 1) == 0)
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
1957
  		return ret;
35e1a5d90   Martin K. Petersen   [SCSI] sd: Detach...
1958
1959
  
  	type = ((buffer[12] >> 1) & 7) + 1; /* P_TYPE 0 = Type 1 */
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
1960
1961
1962
1963
1964
1965
1966
1967
1968
1969
1970
1971
1972
1973
1974
1975
1976
1977
1978
1979
1980
1981
1982
1983
  	if (type > SD_DIF_TYPE3_PROTECTION)
  		ret = -ENODEV;
  	else if (scsi_host_dif_capable(sdp->host, type))
  		ret = 1;
  
  	if (sdkp->first_scan || type != sdkp->protection_type)
  		switch (ret) {
  		case -ENODEV:
  			sd_printk(KERN_ERR, sdkp, "formatted with unsupported" \
  				  " protection type %u. Disabling disk!
  ",
  				  type);
  			break;
  		case 1:
  			sd_printk(KERN_NOTICE, sdkp,
  				  "Enabling DIF Type %u protection
  ", type);
  			break;
  		case 0:
  			sd_printk(KERN_NOTICE, sdkp,
  				  "Disabling DIF Type %u protection
  ", type);
  			break;
  		}
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
1984

be922f478   Martin K. Petersen   [SCSI] sd: Always...
1985
  	sdkp->protection_type = type;
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
1986
  	return ret;
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
1987
  }
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
1988
1989
1990
1991
  static void read_capacity_error(struct scsi_disk *sdkp, struct scsi_device *sdp,
  			struct scsi_sense_hdr *sshdr, int sense_valid,
  			int the_result)
  {
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
1992
1993
1994
1995
1996
1997
1998
1999
2000
2001
2002
2003
  	if (driver_byte(the_result) & DRIVER_SENSE)
  		sd_print_sense_hdr(sdkp, sshdr);
  	else
  		sd_printk(KERN_NOTICE, sdkp, "Sense not available.
  ");
  
  	/*
  	 * Set dirty bit for removable devices if not ready -
  	 * sometimes drives will not report this properly.
  	 */
  	if (sdp->removable &&
  	    sense_valid && sshdr->sense_key == NOT_READY)
2bae0093c   Tejun Heo   [SCSI] sd: implem...
2004
  		set_media_not_present(sdkp);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017
  
  	/*
  	 * We used to set media_present to 0 here to indicate no media
  	 * in the drive, but some drives fail read capacity even with
  	 * media present, so we can't do that.
  	 */
  	sdkp->capacity = 0; /* unknown mapped to zero - as usual */
  }
  
  #define RC16_LEN 32
  #if RC16_LEN > SD_BUF_SIZE
  #error RC16_LEN must not be more than SD_BUF_SIZE
  #endif
3233ac198   James Bottomley   [SCSI] sd: retry ...
2018
  #define READ_CAPACITY_RETRIES_ON_RESET	10
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2019
2020
  static int read_capacity_16(struct scsi_disk *sdkp, struct scsi_device *sdp,
  						unsigned char *buffer)
ea73a9f23   James Bottomley   [SCSI] convert sd...
2021
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2022
  	unsigned char cmd[16];
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2023
2024
  	struct scsi_sense_hdr sshdr;
  	int sense_valid = 0;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2025
  	int the_result;
3233ac198   James Bottomley   [SCSI] sd: retry ...
2026
  	int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2027
  	unsigned int alignment;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2028
2029
  	unsigned long long lba;
  	unsigned sector_size;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2030

5ce524bdf   Hans de Goede   scsi/sd: add a no...
2031
2032
  	if (sdp->no_read_capacity_16)
  		return -EINVAL;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2033
  	do {
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2034
  		memset(cmd, 0, 16);
eb846d9f1   Hannes Reinecke   scsi: rename SERV...
2035
  		cmd[0] = SERVICE_ACTION_IN_16;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2036
2037
2038
  		cmd[1] = SAI_READ_CAPACITY_16;
  		cmd[13] = RC16_LEN;
  		memset(buffer, 0, RC16_LEN);
ea73a9f23   James Bottomley   [SCSI] convert sd...
2039
  		the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2040
2041
  					buffer, RC16_LEN, &sshdr,
  					SD_TIMEOUT, SD_MAX_RETRIES, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2042

ea73a9f23   James Bottomley   [SCSI] convert sd...
2043
  		if (media_not_present(sdkp, &sshdr))
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2044
  			return -ENODEV;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2045

2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2046
  		if (the_result) {
ea73a9f23   James Bottomley   [SCSI] convert sd...
2047
  			sense_valid = scsi_sense_valid(&sshdr);
2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2048
2049
2050
2051
2052
2053
2054
2055
  			if (sense_valid &&
  			    sshdr.sense_key == ILLEGAL_REQUEST &&
  			    (sshdr.asc == 0x20 || sshdr.asc == 0x24) &&
  			    sshdr.ascq == 0x00)
  				/* Invalid Command Operation Code or
  				 * Invalid Field in CDB, just retry
  				 * silently with RC10 */
  				return -EINVAL;
3233ac198   James Bottomley   [SCSI] sd: retry ...
2056
2057
2058
2059
2060
2061
2062
  			if (sense_valid &&
  			    sshdr.sense_key == UNIT_ATTENTION &&
  			    sshdr.asc == 0x29 && sshdr.ascq == 0x00)
  				/* Device reset might occur several times,
  				 * give it one more chance */
  				if (--reset_retries > 0)
  					continue;
2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2063
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2064
2065
2066
  		retries--;
  
  	} while (the_result && retries);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2067
  	if (the_result) {
ef61329db   Hannes Reinecke   scsi: remove scsi...
2068
  		sd_print_result(sdkp, "Read Capacity(16) failed", the_result);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2069
2070
2071
  		read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
  		return -EINVAL;
  	}
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2072

8f76d151b   Dave Hansen   [SCSI] fix sign e...
2073
2074
  	sector_size = get_unaligned_be32(&buffer[8]);
  	lba = get_unaligned_be64(&buffer[0]);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2075

fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
2076
2077
2078
2079
  	if (sd_read_protection_type(sdkp, buffer) < 0) {
  		sdkp->capacity = 0;
  		return -ENODEV;
  	}
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2080
2081
2082
2083
2084
2085
2086
2087
2088
  
  	if ((sizeof(sdkp->capacity) == 4) && (lba >= 0xffffffffULL)) {
  		sd_printk(KERN_ERR, sdkp, "Too big for this kernel. Use a "
  			"kernel compiled with support for large block "
  			"devices.
  ");
  		sdkp->capacity = 0;
  		return -EOVERFLOW;
  	}
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2089
  	/* Logical blocks per physical block exponent */
526f7c795   Martin K. Petersen   [SCSI] sd: Fix ov...
2090
  	sdkp->physical_block_size = (1 << (buffer[13] & 0xf)) * sector_size;
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2091
2092
2093
2094
2095
2096
2097
2098
  
  	/* Lowest aligned logical block */
  	alignment = ((buffer[14] & 0x3f) << 8 | buffer[15]) * sector_size;
  	blk_queue_alignment_offset(sdp->request_queue, alignment);
  	if (alignment && sdkp->first_scan)
  		sd_printk(KERN_NOTICE, sdkp,
  			  "physical block alignment offset: %u
  ", alignment);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2099
2100
  	if (buffer[14] & 0x80) { /* LBPME */
  		sdkp->lbpme = 1;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2101

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2102
2103
  		if (buffer[14] & 0x40) /* LBPRZ */
  			sdkp->lbprz = 1;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2104

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2105
  		sd_config_discard(sdkp, SD_LBP_WS16);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2106
  	}
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2107
2108
2109
2110
2111
2112
2113
2114
2115
2116
2117
  	sdkp->capacity = lba + 1;
  	return sector_size;
  }
  
  static int read_capacity_10(struct scsi_disk *sdkp, struct scsi_device *sdp,
  						unsigned char *buffer)
  {
  	unsigned char cmd[16];
  	struct scsi_sense_hdr sshdr;
  	int sense_valid = 0;
  	int the_result;
3233ac198   James Bottomley   [SCSI] sd: retry ...
2118
  	int retries = 3, reset_retries = READ_CAPACITY_RETRIES_ON_RESET;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2119
2120
2121
2122
2123
2124
2125
2126
2127
2128
2129
2130
2131
2132
  	sector_t lba;
  	unsigned sector_size;
  
  	do {
  		cmd[0] = READ_CAPACITY;
  		memset(&cmd[1], 0, 9);
  		memset(buffer, 0, 8);
  
  		the_result = scsi_execute_req(sdp, cmd, DMA_FROM_DEVICE,
  					buffer, 8, &sshdr,
  					SD_TIMEOUT, SD_MAX_RETRIES, NULL);
  
  		if (media_not_present(sdkp, &sshdr))
  			return -ENODEV;
3233ac198   James Bottomley   [SCSI] sd: retry ...
2133
  		if (the_result) {
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2134
  			sense_valid = scsi_sense_valid(&sshdr);
3233ac198   James Bottomley   [SCSI] sd: retry ...
2135
2136
2137
2138
2139
2140
2141
2142
  			if (sense_valid &&
  			    sshdr.sense_key == UNIT_ATTENTION &&
  			    sshdr.asc == 0x29 && sshdr.ascq == 0x00)
  				/* Device reset might occur several times,
  				 * give it one more chance */
  				if (--reset_retries > 0)
  					continue;
  		}
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2143
2144
2145
2146
2147
  		retries--;
  
  	} while (the_result && retries);
  
  	if (the_result) {
ef61329db   Hannes Reinecke   scsi: remove scsi...
2148
  		sd_print_result(sdkp, "Read Capacity(10) failed", the_result);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2149
2150
2151
  		read_capacity_error(sdkp, sdp, &sshdr, sense_valid, the_result);
  		return -EINVAL;
  	}
8f76d151b   Dave Hansen   [SCSI] fix sign e...
2152
2153
  	sector_size = get_unaligned_be32(&buffer[4]);
  	lba = get_unaligned_be32(&buffer[0]);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2154

5ce524bdf   Hans de Goede   scsi/sd: add a no...
2155
2156
2157
2158
2159
  	if (sdp->no_read_capacity_16 && (lba == 0xffffffff)) {
  		/* Some buggy (usb cardreader) devices return an lba of
  		   0xffffffff when the want to report a size of 0 (with
  		   which they really mean no media is present) */
  		sdkp->capacity = 0;
5cc103506   Linus Torvalds   Merge git://git.k...
2160
  		sdkp->physical_block_size = sector_size;
5ce524bdf   Hans de Goede   scsi/sd: add a no...
2161
2162
  		return sector_size;
  	}
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2163
2164
2165
2166
2167
2168
2169
2170
2171
2172
  	if ((sizeof(sdkp->capacity) == 4) && (lba == 0xffffffff)) {
  		sd_printk(KERN_ERR, sdkp, "Too big for this kernel. Use a "
  			"kernel compiled with support for large block "
  			"devices.
  ");
  		sdkp->capacity = 0;
  		return -EOVERFLOW;
  	}
  
  	sdkp->capacity = lba + 1;
526f7c795   Martin K. Petersen   [SCSI] sd: Fix ov...
2173
  	sdkp->physical_block_size = sector_size;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2174
2175
  	return sector_size;
  }
2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2176
2177
  static int sd_try_rc16_first(struct scsi_device *sdp)
  {
f87146bba   Hannes Reinecke   [SCSI] sd: quiet ...
2178
2179
  	if (sdp->host->max_cmd_len < 16)
  		return 0;
6a0bdffa0   Alan Stern   SCSI & usb-storag...
2180
2181
  	if (sdp->try_rc_10_first)
  		return 0;
2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2182
2183
2184
2185
2186
2187
  	if (sdp->scsi_level > SCSI_SPC_2)
  		return 1;
  	if (scsi_device_protection(sdp))
  		return 1;
  	return 0;
  }
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2188
2189
2190
2191
2192
2193
2194
2195
  /*
   * read disk capacity
   */
  static void
  sd_read_capacity(struct scsi_disk *sdkp, unsigned char *buffer)
  {
  	int sector_size;
  	struct scsi_device *sdp = sdkp->device;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2196
  	sector_t old_capacity = sdkp->capacity;
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2197

2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2198
  	if (sd_try_rc16_first(sdp)) {
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2199
2200
  		sector_size = read_capacity_16(sdkp, sdp, buffer);
  		if (sector_size == -EOVERFLOW)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2201
  			goto got_data;
2b301307f   Matthew Wilcox   [SCSI] sd: Try RE...
2202
2203
2204
2205
  		if (sector_size == -ENODEV)
  			return;
  		if (sector_size < 0)
  			sector_size = read_capacity_10(sdkp, sdp, buffer);
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2206
2207
  		if (sector_size < 0)
  			return;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2208
  	} else {
0da205e01   Matthew Wilcox   [SCSI] sd: Refact...
2209
2210
2211
2212
2213
2214
2215
2216
2217
2218
2219
2220
2221
2222
2223
2224
2225
2226
2227
2228
2229
2230
  		sector_size = read_capacity_10(sdkp, sdp, buffer);
  		if (sector_size == -EOVERFLOW)
  			goto got_data;
  		if (sector_size < 0)
  			return;
  		if ((sizeof(sdkp->capacity) > 4) &&
  		    (sdkp->capacity > 0xffffffffULL)) {
  			int old_sector_size = sector_size;
  			sd_printk(KERN_NOTICE, sdkp, "Very big device. "
  					"Trying to use READ CAPACITY(16).
  ");
  			sector_size = read_capacity_16(sdkp, sdp, buffer);
  			if (sector_size < 0) {
  				sd_printk(KERN_NOTICE, sdkp,
  					"Using 0xffffffff as device size
  ");
  				sdkp->capacity = 1 + (sector_t) 0xffffffff;
  				sector_size = old_sector_size;
  				goto got_data;
  			}
  		}
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2231

5c211caa9   Alan Stern   [SCSI] sd: tell t...
2232
2233
2234
2235
2236
2237
2238
2239
2240
2241
2242
2243
2244
2245
2246
2247
  	/* Some devices are known to return the total number of blocks,
  	 * not the highest block number.  Some devices have versions
  	 * which do this and others which do not.  Some devices we might
  	 * suspect of doing this but we don't know for certain.
  	 *
  	 * If we know the reported capacity is wrong, decrement it.  If
  	 * we can only guess, then assume the number of blocks is even
  	 * (usually true but not always) and err on the side of lowering
  	 * the capacity.
  	 */
  	if (sdp->fix_capacity ||
  	    (sdp->guess_capacity && (sdkp->capacity & 0x01))) {
  		sd_printk(KERN_INFO, sdkp, "Adjusting the sector count "
  				"from its reported value: %llu
  ",
  				(unsigned long long) sdkp->capacity);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2248
  		--sdkp->capacity;
61bf54b71   Oliver Neukum   USB Storage: indi...
2249
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2250
2251
2252
  got_data:
  	if (sector_size == 0) {
  		sector_size = 512;
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2253
2254
2255
  		sd_printk(KERN_NOTICE, sdkp, "Sector size 0 reported, "
  			  "assuming 512.
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2256
2257
2258
2259
2260
  	}
  
  	if (sector_size != 512 &&
  	    sector_size != 1024 &&
  	    sector_size != 2048 &&
74856fbf4   Mark Hounschell   sd: Disable suppo...
2261
  	    sector_size != 4096) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2262
2263
2264
  		sd_printk(KERN_NOTICE, sdkp, "Unsupported sector size %d.
  ",
  			  sector_size);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2265
2266
2267
2268
2269
2270
2271
2272
2273
2274
2275
2276
2277
2278
2279
  		/*
  		 * The user might want to re-format the drive with
  		 * a supported sectorsize.  Once this happens, it
  		 * would be relatively trivial to set the thing up.
  		 * For this reason, we leave the thing in the table.
  		 */
  		sdkp->capacity = 0;
  		/*
  		 * set a bogus sector size so the normal read/write
  		 * logic in the block layer will eventually refuse any
  		 * request on this device without tripping over power
  		 * of two sector size assumptions
  		 */
  		sector_size = 512;
  	}
e1defc4ff   Martin K. Petersen   block: Do away wi...
2280
  	blk_queue_logical_block_size(sdp->request_queue, sector_size);
7404ad3b6   James Bottomley   [SCSI] sd: use ge...
2281

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2282
  	{
7404ad3b6   James Bottomley   [SCSI] sd: use ge...
2283
  		char cap_str_2[10], cap_str_10[10];
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2284

b9f28d863   James Bottomley   sd, mmc, virtio_b...
2285
2286
2287
2288
  		string_get_size(sdkp->capacity, sector_size,
  				STRING_UNITS_2, cap_str_2, sizeof(cap_str_2));
  		string_get_size(sdkp->capacity, sector_size,
  				STRING_UNITS_10, cap_str_10,
7404ad3b6   James Bottomley   [SCSI] sd: use ge...
2289
  				sizeof(cap_str_10));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2290

ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2291
  		if (sdkp->first_scan || old_capacity != sdkp->capacity) {
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2292
  			sd_printk(KERN_NOTICE, sdkp,
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2293
2294
  				  "%llu %d-byte logical blocks: (%s/%s)
  ",
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2295
2296
  				  (unsigned long long)sdkp->capacity,
  				  sector_size, cap_str_10, cap_str_2);
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2297

526f7c795   Martin K. Petersen   [SCSI] sd: Fix ov...
2298
  			if (sdkp->physical_block_size != sector_size)
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2299
2300
2301
  				sd_printk(KERN_NOTICE, sdkp,
  					  "%u-byte physical blocks
  ",
526f7c795   Martin K. Petersen   [SCSI] sd: Fix ov...
2302
  					  sdkp->physical_block_size);
ea09bcc9c   Martin K. Petersen   sd: Physical bloc...
2303
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2304
  	}
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2305
  	if (sdkp->capacity > 0xffffffff)
bcdb247c6   Martin K. Petersen   sd: Limit transfe...
2306
  		sdp->use_16_for_rw = 1;
53ad570be   Jason J. Herne   [SCSI] sd: Use SC...
2307

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2308
2309
2310
2311
2312
2313
2314
  	/* Rescale capacity to 512-byte units */
  	if (sector_size == 4096)
  		sdkp->capacity <<= 3;
  	else if (sector_size == 2048)
  		sdkp->capacity <<= 2;
  	else if (sector_size == 1024)
  		sdkp->capacity <<= 1;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2315

526f7c795   Martin K. Petersen   [SCSI] sd: Fix ov...
2316
2317
  	blk_queue_physical_block_size(sdp->request_queue,
  				      sdkp->physical_block_size);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2318
2319
2320
2321
2322
  	sdkp->device->sector_size = sector_size;
  }
  
  /* called with buffer of length 512 */
  static inline int
ea73a9f23   James Bottomley   [SCSI] convert sd...
2323
2324
2325
  sd_do_mode_sense(struct scsi_device *sdp, int dbd, int modepage,
  		 unsigned char *buffer, int len, struct scsi_mode_data *data,
  		 struct scsi_sense_hdr *sshdr)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2326
  {
ea73a9f23   James Bottomley   [SCSI] convert sd...
2327
  	return scsi_mode_sense(sdp, dbd, modepage, buffer, len,
1cf72699c   James Bottomley   [SCSI] convert th...
2328
  			       SD_TIMEOUT, SD_MAX_RETRIES, data,
ea73a9f23   James Bottomley   [SCSI] convert sd...
2329
  			       sshdr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2330
2331
2332
2333
  }
  
  /*
   * read write protect setting, if possible - called only in sd_revalidate_disk()
489708007   Al Viro   [PATCH] sd: fix m...
2334
   * called with buffer of length SD_BUF_SIZE
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2335
2336
   */
  static void
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2337
  sd_read_write_protect_flag(struct scsi_disk *sdkp, unsigned char *buffer)
ea73a9f23   James Bottomley   [SCSI] convert sd...
2338
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2339
  	int res;
ea73a9f23   James Bottomley   [SCSI] convert sd...
2340
  	struct scsi_device *sdp = sdkp->device;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2341
  	struct scsi_mode_data data;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2342
  	int old_wp = sdkp->write_prot;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2343
2344
  
  	set_disk_ro(sdkp->disk, 0);
ea73a9f23   James Bottomley   [SCSI] convert sd...
2345
  	if (sdp->skip_ms_page_3f) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2346
2347
  		sd_first_printk(KERN_NOTICE, sdkp, "Assuming Write Enabled
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2348
2349
  		return;
  	}
ea73a9f23   James Bottomley   [SCSI] convert sd...
2350
2351
  	if (sdp->use_192_bytes_for_3f) {
  		res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 192, &data, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2352
2353
2354
2355
2356
2357
  	} else {
  		/*
  		 * First attempt: ask for all pages (0x3F), but only 4 bytes.
  		 * We have to start carefully: some devices hang if we ask
  		 * for more than is available.
  		 */
ea73a9f23   James Bottomley   [SCSI] convert sd...
2358
  		res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 4, &data, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2359
2360
2361
2362
2363
2364
2365
2366
  
  		/*
  		 * Second attempt: ask for page 0 When only page 0 is
  		 * implemented, a request for page 3F may return Sense Key
  		 * 5: Illegal Request, Sense Code 24: Invalid field in
  		 * CDB.
  		 */
  		if (!scsi_status_is_good(res))
ea73a9f23   James Bottomley   [SCSI] convert sd...
2367
  			res = sd_do_mode_sense(sdp, 0, 0, buffer, 4, &data, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2368
2369
2370
2371
2372
  
  		/*
  		 * Third attempt: ask 255 bytes, as we did earlier.
  		 */
  		if (!scsi_status_is_good(res))
ea73a9f23   James Bottomley   [SCSI] convert sd...
2373
2374
  			res = sd_do_mode_sense(sdp, 0, 0x3F, buffer, 255,
  					       &data, NULL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2375
2376
2377
  	}
  
  	if (!scsi_status_is_good(res)) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2378
  		sd_first_printk(KERN_WARNING, sdkp,
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2379
2380
  			  "Test WP failed, assume Write Enabled
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2381
2382
2383
  	} else {
  		sdkp->write_prot = ((data.device_specific & 0x80) != 0);
  		set_disk_ro(sdkp->disk, sdkp->write_prot);
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2384
2385
2386
2387
2388
2389
2390
2391
2392
  		if (sdkp->first_scan || old_wp != sdkp->write_prot) {
  			sd_printk(KERN_NOTICE, sdkp, "Write Protect is %s
  ",
  				  sdkp->write_prot ? "on" : "off");
  			sd_printk(KERN_DEBUG, sdkp,
  				  "Mode Sense: %02x %02x %02x %02x
  ",
  				  buffer[0], buffer[1], buffer[2], buffer[3]);
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2393
2394
2395
2396
2397
  	}
  }
  
  /*
   * sd_read_cache_type - called only from sd_revalidate_disk()
489708007   Al Viro   [PATCH] sd: fix m...
2398
   * called with buffer of length SD_BUF_SIZE
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2399
2400
   */
  static void
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2401
  sd_read_cache_type(struct scsi_disk *sdkp, unsigned char *buffer)
631e8a139   Al Viro   [SCSI] TYPE_RBC c...
2402
  {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2403
  	int len = 0, res;
ea73a9f23   James Bottomley   [SCSI] convert sd...
2404
  	struct scsi_device *sdp = sdkp->device;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2405

631e8a139   Al Viro   [SCSI] TYPE_RBC c...
2406
2407
  	int dbd;
  	int modepage;
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2408
  	int first_len;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2409
2410
  	struct scsi_mode_data data;
  	struct scsi_sense_hdr sshdr;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2411
2412
2413
  	int old_wce = sdkp->WCE;
  	int old_rcd = sdkp->RCD;
  	int old_dpofua = sdkp->DPOFUA;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2414

39c60a094   James Bottomley   [SCSI] sd: fix ar...
2415
2416
2417
  
  	if (sdkp->cache_override)
  		return;
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2418
2419
2420
2421
2422
2423
2424
2425
2426
2427
2428
2429
2430
  	first_len = 4;
  	if (sdp->skip_ms_page_8) {
  		if (sdp->type == TYPE_RBC)
  			goto defaults;
  		else {
  			if (sdp->skip_ms_page_3f)
  				goto defaults;
  			modepage = 0x3F;
  			if (sdp->use_192_bytes_for_3f)
  				first_len = 192;
  			dbd = 0;
  		}
  	} else if (sdp->type == TYPE_RBC) {
631e8a139   Al Viro   [SCSI] TYPE_RBC c...
2431
2432
2433
2434
2435
2436
  		modepage = 6;
  		dbd = 8;
  	} else {
  		modepage = 8;
  		dbd = 0;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2437
  	/* cautiously ask */
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2438
2439
  	res = sd_do_mode_sense(sdp, dbd, modepage, buffer, first_len,
  			&data, &sshdr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2440
2441
2442
  
  	if (!scsi_status_is_good(res))
  		goto bad_sense;
6d73c8514   Al Viro   [SCSI] scsi_lib: ...
2443
2444
  	if (!data.header_length) {
  		modepage = 6;
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2445
  		first_len = 0;
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2446
2447
2448
  		sd_first_printk(KERN_ERR, sdkp,
  				"Missing header in MODE_SENSE response
  ");
6d73c8514   Al Viro   [SCSI] scsi_lib: ...
2449
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2450
2451
2452
2453
2454
2455
2456
2457
2458
  	/* that went OK, now ask for the proper length */
  	len = data.length;
  
  	/*
  	 * We're only interested in the first three bytes, actually.
  	 * But the data cache page is defined for the first 20.
  	 */
  	if (len < 3)
  		goto bad_sense;
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2459
  	else if (len > SD_BUF_SIZE) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2460
  		sd_first_printk(KERN_NOTICE, sdkp, "Truncating mode parameter "
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2461
2462
2463
2464
2465
2466
  			  "data from %d to %d bytes
  ", len, SD_BUF_SIZE);
  		len = SD_BUF_SIZE;
  	}
  	if (modepage == 0x3F && sdp->use_192_bytes_for_3f)
  		len = 192;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2467
2468
  
  	/* Get the data */
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2469
2470
2471
  	if (len > first_len)
  		res = sd_do_mode_sense(sdp, dbd, modepage, buffer, len,
  				&data, &sshdr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2472
2473
  
  	if (scsi_status_is_good(res)) {
631e8a139   Al Viro   [SCSI] TYPE_RBC c...
2474
  		int offset = data.header_length + data.block_descriptor_length;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2475

0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2476
2477
2478
2479
2480
2481
2482
2483
  		while (offset < len) {
  			u8 page_code = buffer[offset] & 0x3F;
  			u8 spf       = buffer[offset] & 0x40;
  
  			if (page_code == 8 || page_code == 6) {
  				/* We're interested only in the first 3 bytes.
  				 */
  				if (len - offset <= 2) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2484
2485
2486
2487
  					sd_first_printk(KERN_ERR, sdkp,
  						"Incomplete mode parameter "
  							"data
  ");
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2488
2489
2490
2491
2492
2493
2494
2495
2496
2497
2498
2499
2500
  					goto defaults;
  				} else {
  					modepage = page_code;
  					goto Page_found;
  				}
  			} else {
  				/* Go to the next page */
  				if (spf && len - offset > 3)
  					offset += 4 + (buffer[offset+2] << 8) +
  						buffer[offset+3];
  				else if (!spf && len - offset > 1)
  					offset += 2 + buffer[offset+1];
  				else {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2501
2502
2503
2504
  					sd_first_printk(KERN_ERR, sdkp,
  							"Incomplete mode "
  							"parameter data
  ");
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2505
2506
2507
  					goto defaults;
  				}
  			}
489708007   Al Viro   [PATCH] sd: fix m...
2508
  		}
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2509
2510
  		sd_first_printk(KERN_ERR, sdkp, "No Caching mode page found
  ");
984f1733f   Alan Stern   [SCSI] sd: Fix po...
2511
  		goto defaults;
0bcaa1115   Luben Tuikov   [SCSI] Retrieve t...
2512
  	Page_found:
631e8a139   Al Viro   [SCSI] TYPE_RBC c...
2513
2514
2515
2516
2517
2518
2519
  		if (modepage == 8) {
  			sdkp->WCE = ((buffer[offset + 2] & 0x04) != 0);
  			sdkp->RCD = ((buffer[offset + 2] & 0x01) != 0);
  		} else {
  			sdkp->WCE = ((buffer[offset + 2] & 0x01) == 0);
  			sdkp->RCD = 0;
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2520

007365ad6   Tejun Heo   [BLOCK] scsi: add...
2521
  		sdkp->DPOFUA = (data.device_specific & 0x10) != 0;
b14bf2d0c   Alan Stern   usb-storage/SCSI:...
2522
2523
2524
2525
2526
  		if (sdp->broken_fua) {
  			sd_first_printk(KERN_NOTICE, sdkp, "Disabling FUA
  ");
  			sdkp->DPOFUA = 0;
  		} else if (sdkp->DPOFUA && !sdkp->device->use_10_for_rw) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2527
  			sd_first_printk(KERN_NOTICE, sdkp,
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2528
2529
  				  "Uses READ/WRITE(6), disabling FUA
  ");
007365ad6   Tejun Heo   [BLOCK] scsi: add...
2530
2531
  			sdkp->DPOFUA = 0;
  		}
2eefd57b9   Sujit Reddy Thumma   sd: Avoid sending...
2532
2533
2534
  		/* No cache flush allowed for write protected devices */
  		if (sdkp->WCE && sdkp->write_prot)
  			sdkp->WCE = 0;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2535
2536
2537
2538
2539
2540
2541
2542
2543
  		if (sdkp->first_scan || old_wce != sdkp->WCE ||
  		    old_rcd != sdkp->RCD || old_dpofua != sdkp->DPOFUA)
  			sd_printk(KERN_NOTICE, sdkp,
  				  "Write cache: %s, read cache: %s, %s
  ",
  				  sdkp->WCE ? "enabled" : "disabled",
  				  sdkp->RCD ? "disabled" : "enabled",
  				  sdkp->DPOFUA ? "supports DPO and FUA"
  				  : "doesn't support DPO or FUA");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2544
2545
2546
2547
2548
  
  		return;
  	}
  
  bad_sense:
ea73a9f23   James Bottomley   [SCSI] convert sd...
2549
  	if (scsi_sense_valid(&sshdr) &&
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2550
2551
  	    sshdr.sense_key == ILLEGAL_REQUEST &&
  	    sshdr.asc == 0x24 && sshdr.ascq == 0x0)
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2552
  		/* Invalid field in CDB */
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2553
2554
  		sd_first_printk(KERN_NOTICE, sdkp, "Cache data unavailable
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2555
  	else
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2556
2557
2558
  		sd_first_printk(KERN_ERR, sdkp,
  				"Asking for cache data failed
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2559
2560
  
  defaults:
b81478d82   Namjae Jeon   [SCSI] set to WCE...
2561
  	if (sdp->wce_default_on) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2562
2563
2564
  		sd_first_printk(KERN_NOTICE, sdkp,
  				"Assuming drive cache: write back
  ");
b81478d82   Namjae Jeon   [SCSI] set to WCE...
2565
2566
  		sdkp->WCE = 1;
  	} else {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2567
2568
2569
  		sd_first_printk(KERN_ERR, sdkp,
  				"Assuming drive cache: write through
  ");
b81478d82   Namjae Jeon   [SCSI] set to WCE...
2570
2571
  		sdkp->WCE = 0;
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2572
  	sdkp->RCD = 0;
489708007   Al Viro   [PATCH] sd: fix m...
2573
  	sdkp->DPOFUA = 0;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2574
  }
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
2575
2576
2577
2578
  /*
   * The ATO bit indicates whether the DIF application tag is available
   * for use by the operating system.
   */
439d77f70   H Hartley Sweeten   scsi/sd.c: quiet ...
2579
  static void sd_read_app_tag_own(struct scsi_disk *sdkp, unsigned char *buffer)
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
2580
2581
2582
2583
2584
2585
2586
2587
2588
2589
2590
2591
2592
2593
2594
2595
2596
  {
  	int res, offset;
  	struct scsi_device *sdp = sdkp->device;
  	struct scsi_mode_data data;
  	struct scsi_sense_hdr sshdr;
  
  	if (sdp->type != TYPE_DISK)
  		return;
  
  	if (sdkp->protection_type == 0)
  		return;
  
  	res = scsi_mode_sense(sdp, 1, 0x0a, buffer, 36, SD_TIMEOUT,
  			      SD_MAX_RETRIES, &data, &sshdr);
  
  	if (!scsi_status_is_good(res) || !data.header_length ||
  	    data.length < 6) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2597
  		sd_first_printk(KERN_WARNING, sdkp,
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
2598
2599
2600
2601
2602
2603
2604
2605
2606
2607
2608
2609
  			  "getting Control mode page failed, assume no ATO
  ");
  
  		if (scsi_sense_valid(&sshdr))
  			sd_print_sense_hdr(sdkp, &sshdr);
  
  		return;
  	}
  
  	offset = data.header_length + data.block_descriptor_length;
  
  	if ((buffer[offset] & 0x3f) != 0x0a) {
b2bff6ceb   Martin K. Petersen   [SCSI] sd: Quiesc...
2610
2611
  		sd_first_printk(KERN_ERR, sdkp, "ATO Got wrong page
  ");
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
2612
2613
2614
2615
2616
2617
2618
2619
2620
2621
  		return;
  	}
  
  	if ((buffer[offset + 5] & 0x80) == 0)
  		return;
  
  	sdkp->ATO = 1;
  
  	return;
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2622
  /**
d11b69169   Martin K. Petersen   sd: Block limits ...
2623
2624
2625
2626
2627
2628
   * sd_read_block_limits - Query disk device for preferred I/O sizes.
   * @disk: disk to query
   */
  static void sd_read_block_limits(struct scsi_disk *sdkp)
  {
  	unsigned int sector_sz = sdkp->device->sector_size;
bb2d3de18   Martin K. Petersen   [SCSI] sd: Fix VP...
2629
  	const int vpd_len = 64;
e3deec090   James Bottomley   [SCSI] eliminate ...
2630
  	unsigned char *buffer = kmalloc(vpd_len, GFP_KERNEL);
d11b69169   Martin K. Petersen   sd: Block limits ...
2631

e3deec090   James Bottomley   [SCSI] eliminate ...
2632
2633
2634
2635
  	if (!buffer ||
  	    /* Block Limits VPD */
  	    scsi_get_vpd_page(sdkp->device, 0xb0, buffer, vpd_len))
  		goto out;
d11b69169   Martin K. Petersen   sd: Block limits ...
2636
2637
2638
  
  	blk_queue_io_min(sdkp->disk->queue,
  			 get_unaligned_be16(&buffer[6]) * sector_sz);
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2639
2640
2641
  
  	sdkp->max_xfer_blocks = get_unaligned_be32(&buffer[8]);
  	sdkp->opt_xfer_blocks = get_unaligned_be32(&buffer[12]);
d11b69169   Martin K. Petersen   sd: Block limits ...
2642

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2643
2644
  	if (buffer[3] == 0x3c) {
  		unsigned int lba_count, desc_count;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2645

5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2646
  		sdkp->max_ws_blocks = (u32)get_unaligned_be64(&buffer[36]);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2647

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2648
  		if (!sdkp->lbpme)
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2649
  			goto out;
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2650

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2651
2652
  		lba_count = get_unaligned_be32(&buffer[20]);
  		desc_count = get_unaligned_be32(&buffer[24]);
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2653

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2654
2655
  		if (lba_count && desc_count)
  			sdkp->max_unmap_blocks = lba_count;
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2656

c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2657
  		sdkp->unmap_granularity = get_unaligned_be32(&buffer[28]);
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2658
2659
  
  		if (buffer[32] & 0x80)
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2660
  			sdkp->unmap_alignment =
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2661
  				get_unaligned_be32(&buffer[32]) & ~(1 << 31);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2662
2663
2664
2665
2666
2667
2668
2669
2670
  
  		if (!sdkp->lbpvpd) { /* LBP VPD page not provided */
  
  			if (sdkp->max_unmap_blocks)
  				sd_config_discard(sdkp, SD_LBP_UNMAP);
  			else
  				sd_config_discard(sdkp, SD_LBP_WS16);
  
  		} else {	/* LBP VPD page tells us what to use */
e461338b6   Martin K. Petersen   sd: tweak discard...
2671
2672
2673
  			if (sdkp->lbpu && sdkp->max_unmap_blocks && !sdkp->lbprz)
  				sd_config_discard(sdkp, SD_LBP_UNMAP);
  			else if (sdkp->lbpws)
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2674
2675
2676
  				sd_config_discard(sdkp, SD_LBP_WS16);
  			else if (sdkp->lbpws10)
  				sd_config_discard(sdkp, SD_LBP_WS10);
7985090aa   Martin K. Petersen   sd: disable disca...
2677
2678
  			else if (sdkp->lbpu && sdkp->max_unmap_blocks)
  				sd_config_discard(sdkp, SD_LBP_UNMAP);
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2679
2680
2681
  			else
  				sd_config_discard(sdkp, SD_LBP_DISABLE);
  		}
e339c1a7c   Martin K. Petersen   [SCSI] sd: WRITE ...
2682
  	}
e3deec090   James Bottomley   [SCSI] eliminate ...
2683
   out:
d11b69169   Martin K. Petersen   sd: Block limits ...
2684
2685
2686
2687
  	kfree(buffer);
  }
  
  /**
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2688
2689
2690
2691
2692
   * sd_read_block_characteristics - Query block dev. characteristics
   * @disk: disk to query
   */
  static void sd_read_block_characteristics(struct scsi_disk *sdkp)
  {
e3deec090   James Bottomley   [SCSI] eliminate ...
2693
  	unsigned char *buffer;
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2694
  	u16 rot;
bb2d3de18   Martin K. Petersen   [SCSI] sd: Fix VP...
2695
  	const int vpd_len = 64;
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2696

e3deec090   James Bottomley   [SCSI] eliminate ...
2697
  	buffer = kmalloc(vpd_len, GFP_KERNEL);
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2698

e3deec090   James Bottomley   [SCSI] eliminate ...
2699
2700
2701
2702
  	if (!buffer ||
  	    /* Block Device Characteristics VPD */
  	    scsi_get_vpd_page(sdkp->device, 0xb1, buffer, vpd_len))
  		goto out;
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2703
2704
  
  	rot = get_unaligned_be16(&buffer[4]);
b277da0a8   Mike Snitzer   block: disable en...
2705
  	if (rot == 1) {
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2706
  		queue_flag_set_unlocked(QUEUE_FLAG_NONROT, sdkp->disk->queue);
b277da0a8   Mike Snitzer   block: disable en...
2707
2708
  		queue_flag_clear_unlocked(QUEUE_FLAG_ADD_RANDOM, sdkp->disk->queue);
  	}
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2709

e3deec090   James Bottomley   [SCSI] eliminate ...
2710
   out:
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2711
2712
  	kfree(buffer);
  }
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2713
  /**
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2714
   * sd_read_block_provisioning - Query provisioning VPD page
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2715
2716
   * @disk: disk to query
   */
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2717
  static void sd_read_block_provisioning(struct scsi_disk *sdkp)
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2718
2719
2720
  {
  	unsigned char *buffer;
  	const int vpd_len = 8;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2721
  	if (sdkp->lbpme == 0)
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2722
2723
2724
2725
2726
2727
  		return;
  
  	buffer = kmalloc(vpd_len, GFP_KERNEL);
  
  	if (!buffer || scsi_get_vpd_page(sdkp->device, 0xb2, buffer, vpd_len))
  		goto out;
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2728
2729
2730
2731
  	sdkp->lbpvpd	= 1;
  	sdkp->lbpu	= (buffer[5] >> 7) & 1;	/* UNMAP */
  	sdkp->lbpws	= (buffer[5] >> 6) & 1;	/* WRITE SAME(16) with UNMAP */
  	sdkp->lbpws10	= (buffer[5] >> 5) & 1;	/* WRITE SAME(10) with UNMAP */
045d3fe76   Martin K. Petersen   [SCSI] sd: Update...
2732
2733
2734
2735
  
   out:
  	kfree(buffer);
  }
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2736
2737
  static void sd_read_write_same(struct scsi_disk *sdkp, unsigned char *buffer)
  {
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
2738
  	struct scsi_device *sdev = sdkp->device;
54b2b50c2   Martin K. Petersen   [SCSI] Disable WR...
2739
2740
2741
2742
2743
  	if (sdev->host->no_write_same) {
  		sdev->no_write_same = 1;
  
  		return;
  	}
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
2744
  	if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, INQUIRY) < 0) {
af73623f5   Bernd Schubert   [SCSI] sd: Reduce...
2745
2746
  		/* too large values might cause issues with arcmsr */
  		int vpd_buf_len = 64;
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
2747
2748
2749
2750
2751
2752
  		sdev->no_report_opcodes = 1;
  
  		/* Disable WRITE SAME if REPORT SUPPORTED OPERATION
  		 * CODES is unsupported and the device has an ATA
  		 * Information VPD page (SAT).
  		 */
af73623f5   Bernd Schubert   [SCSI] sd: Reduce...
2753
  		if (!scsi_get_vpd_page(sdev, 0x89, buffer, vpd_buf_len))
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
2754
2755
2756
2757
  			sdev->no_write_same = 1;
  	}
  
  	if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME_16) == 1)
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2758
  		sdkp->ws16 = 1;
66c28f971   Martin K. Petersen   [SCSI] sd: Update...
2759
2760
2761
  
  	if (scsi_report_opcode(sdev, buffer, SD_BUF_SIZE, WRITE_SAME) == 1)
  		sdkp->ws10 = 1;
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2762
  }
ffd4bc2a9   Martin K. Petersen   [SCSI] sd: Avoid ...
2763
2764
  static int sd_try_extended_inquiry(struct scsi_device *sdp)
  {
c1d40a527   Martin K. Petersen   scsi: add a black...
2765
2766
2767
2768
2769
  	/* Attempt VPD inquiry if the device blacklist explicitly calls
  	 * for it.
  	 */
  	if (sdp->try_vpd_pages)
  		return 1;
ffd4bc2a9   Martin K. Petersen   [SCSI] sd: Avoid ...
2770
2771
2772
2773
2774
  	/*
  	 * Although VPD inquiries can go to SCSI-2 type devices,
  	 * some USB ones crash on receiving them, and the pages
  	 * we currently ask for are for SPC-3 and beyond
  	 */
09b6b51b0   Alan Stern   SCSI & usb-storag...
2775
  	if (sdp->scsi_level > SCSI_SPC_2 && !sdp->skip_vpd_pages)
ffd4bc2a9   Martin K. Petersen   [SCSI] sd: Avoid ...
2776
2777
2778
  		return 1;
  	return 0;
  }
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2779
2780
2781
2782
  static inline u32 logical_to_sectors(struct scsi_device *sdev, u32 blocks)
  {
  	return blocks << (ilog2(sdev->sector_size) - 9);
  }
3821d7689   Martin K. Petersen   sd: Detect non-ro...
2783
  /**
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2784
2785
2786
2787
2788
2789
2790
2791
   *	sd_revalidate_disk - called the first time a new disk is seen,
   *	performs disk spin up, read_capacity, etc.
   *	@disk: struct gendisk we care about
   **/
  static int sd_revalidate_disk(struct gendisk *disk)
  {
  	struct scsi_disk *sdkp = scsi_disk(disk);
  	struct scsi_device *sdp = sdkp->device;
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2792
  	struct request_queue *q = sdkp->disk->queue;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2793
  	unsigned char *buffer;
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2794
  	unsigned int dev_max, rw_max;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2795

fa0d34be0   Martin K. Petersen   [SCSI] sd: conver...
2796
2797
2798
  	SCSI_LOG_HLQUEUE(3, sd_printk(KERN_INFO, sdkp,
  				      "sd_revalidate_disk
  "));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2799
2800
2801
2802
2803
2804
2805
  
  	/*
  	 * If the device is offline, don't try and read capacity or any
  	 * of the other niceties.
  	 */
  	if (!scsi_device_online(sdp))
  		goto out;
a6123f142   Bernhard Walle   [SCSI] sd: remove...
2806
  	buffer = kmalloc(SD_BUF_SIZE, GFP_KERNEL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2807
  	if (!buffer) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2808
2809
2810
  		sd_printk(KERN_WARNING, sdkp, "sd_revalidate_disk: Memory "
  			  "allocation failure.
  ");
ea73a9f23   James Bottomley   [SCSI] convert sd...
2811
  		goto out;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2812
  	}
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2813
  	sd_spinup_disk(sdkp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2814
2815
2816
2817
2818
2819
  
  	/*
  	 * Without media there is no reason to ask; moreover, some devices
  	 * react badly if we do.
  	 */
  	if (sdkp->media_present) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2820
  		sd_read_capacity(sdkp, buffer);
ffd4bc2a9   Martin K. Petersen   [SCSI] sd: Avoid ...
2821
2822
  
  		if (sd_try_extended_inquiry(sdp)) {
c98a0eb0e   Martin K. Petersen   [SCSI] sd: Logica...
2823
  			sd_read_block_provisioning(sdkp);
ffd4bc2a9   Martin K. Petersen   [SCSI] sd: Avoid ...
2824
2825
2826
  			sd_read_block_limits(sdkp);
  			sd_read_block_characteristics(sdkp);
  		}
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
2827
2828
  		sd_read_write_protect_flag(sdkp, buffer);
  		sd_read_cache_type(sdkp, buffer);
e0597d700   Martin K. Petersen   [SCSI] sd: Identi...
2829
  		sd_read_app_tag_own(sdkp, buffer);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2830
  		sd_read_write_same(sdkp, buffer);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2831
  	}
461d4e90c   Tejun Heo   [BLOCK] update SC...
2832

70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2833
  	sdkp->first_scan = 0;
461d4e90c   Tejun Heo   [BLOCK] update SC...
2834
2835
  	/*
  	 * We now have all cache related info, determine how we deal
4913efe45   Tejun Heo   block: deprecate ...
2836
  	 * with flush requests.
461d4e90c   Tejun Heo   [BLOCK] update SC...
2837
  	 */
cb2fb68d0   Vaughan Cao   sd: notify block ...
2838
  	sd_set_flush_flag(sdkp);
461d4e90c   Tejun Heo   [BLOCK] update SC...
2839

ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2840
2841
2842
2843
2844
2845
2846
2847
2848
  	/* Initial block count limit based on CDB TRANSFER LENGTH field size. */
  	dev_max = sdp->use_16_for_rw ? SD_MAX_XFER_BLOCKS : SD_DEF_XFER_BLOCKS;
  
  	/* Some devices report a maximum block count for READ/WRITE requests. */
  	dev_max = min_not_zero(dev_max, sdkp->max_xfer_blocks);
  	q->limits.max_dev_sectors = logical_to_sectors(sdp, dev_max);
  
  	/*
  	 * Use the device's preferred I/O size for reads and writes
9c1d9c207   Martin K. Petersen   sd: Reject optima...
2849
2850
  	 * unless the reported value is unreasonably small, large, or
  	 * garbage.
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2851
  	 */
9c1d9c207   Martin K. Petersen   sd: Reject optima...
2852
2853
2854
2855
  	if (sdkp->opt_xfer_blocks &&
  	    sdkp->opt_xfer_blocks <= dev_max &&
  	    sdkp->opt_xfer_blocks <= SD_DEF_XFER_BLOCKS &&
  	    sdkp->opt_xfer_blocks * sdp->sector_size >= PAGE_CACHE_SIZE)
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2856
  		rw_max = q->limits.io_opt =
d0eb20a86   Martin K. Petersen   sd: Optimal I/O s...
2857
  			sdkp->opt_xfer_blocks * sdp->sector_size;
ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2858
2859
  	else
  		rw_max = BLK_DEF_MAX_SECTORS;
3a9794d32   Brian King   sd: Fix max trans...
2860

ca369d51b   Martin K. Petersen   block/sd: Fix dev...
2861
2862
  	/* Combine with controller limits */
  	q->limits.max_sectors = min(rw_max, queue_max_hw_sectors(q));
4f258a463   Martin K. Petersen   sd: Fix maximum I...
2863

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2864
  	set_capacity(disk, sdkp->capacity);
5db44863b   Martin K. Petersen   [SCSI] sd: Implem...
2865
  	sd_config_write_same(sdkp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2866
  	kfree(buffer);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2867
2868
2869
2870
2871
   out:
  	return 0;
  }
  
  /**
72ec24bd7   Tejun Heo   SCSI: implement s...
2872
2873
2874
2875
2876
2877
2878
2879
2880
2881
2882
2883
2884
2885
2886
2887
2888
2889
2890
2891
   *	sd_unlock_native_capacity - unlock native capacity
   *	@disk: struct gendisk to set capacity for
   *
   *	Block layer calls this function if it detects that partitions
   *	on @disk reach beyond the end of the device.  If the SCSI host
   *	implements ->unlock_native_capacity() method, it's invoked to
   *	give it a chance to adjust the device capacity.
   *
   *	CONTEXT:
   *	Defined by block layer.  Might sleep.
   */
  static void sd_unlock_native_capacity(struct gendisk *disk)
  {
  	struct scsi_device *sdev = scsi_disk(disk)->device;
  
  	if (sdev->host->hostt->unlock_native_capacity)
  		sdev->host->hostt->unlock_native_capacity(sdev);
  }
  
  /**
3e1a7ff8a   Tejun Heo   block: allow disk...
2892
2893
2894
2895
2896
2897
2898
2899
2900
2901
2902
   *	sd_format_disk_name - format disk name
   *	@prefix: name prefix - ie. "sd" for SCSI disks
   *	@index: index of the disk to format name for
   *	@buf: output buffer
   *	@buflen: length of the output buffer
   *
   *	SCSI disk names starts at sda.  The 26th device is sdz and the
   *	27th is sdaa.  The last one for two lettered suffix is sdzz
   *	which is followed by sdaaa.
   *
   *	This is basically 26 base counting with one extra 'nil' entry
3ad2f3fbb   Daniel Mack   tree-wide: Assort...
2903
   *	at the beginning from the second digit on and can be
3e1a7ff8a   Tejun Heo   block: allow disk...
2904
2905
2906
2907
2908
2909
2910
2911
2912
2913
2914
2915
2916
2917
2918
2919
2920
2921
2922
2923
2924
2925
2926
2927
2928
2929
2930
2931
2932
2933
2934
2935
   *	determined using similar method as 26 base conversion with the
   *	index shifted -1 after each digit is computed.
   *
   *	CONTEXT:
   *	Don't care.
   *
   *	RETURNS:
   *	0 on success, -errno on failure.
   */
  static int sd_format_disk_name(char *prefix, int index, char *buf, int buflen)
  {
  	const int base = 'z' - 'a' + 1;
  	char *begin = buf + strlen(prefix);
  	char *end = buf + buflen;
  	char *p;
  	int unit;
  
  	p = end - 1;
  	*p = '\0';
  	unit = base;
  	do {
  		if (p == begin)
  			return -EINVAL;
  		*--p = 'a' + (index % unit);
  		index = (index / unit) - 1;
  	} while (index >= 0);
  
  	memmove(begin, p, end - p);
  	memcpy(buf, prefix, strlen(prefix));
  
  	return 0;
  }
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2936
2937
2938
2939
2940
2941
2942
2943
2944
2945
2946
2947
2948
2949
2950
  /*
   * The asynchronous part of sd_probe
   */
  static void sd_probe_async(void *data, async_cookie_t cookie)
  {
  	struct scsi_disk *sdkp = data;
  	struct scsi_device *sdp;
  	struct gendisk *gd;
  	u32 index;
  	struct device *dev;
  
  	sdp = sdkp->device;
  	gd = sdkp->disk;
  	index = sdkp->index;
  	dev = &sdp->sdev_gendev;
1a03ae0f5   Michael Reed   [SCSI] sd name sp...
2951
2952
2953
  	gd->major = sd_major((index & 0xf0) >> 4);
  	gd->first_minor = ((index & 0xf) << 4) | (index & 0xfff00);
  	gd->minors = SD_MINORS;
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2954
2955
2956
  	gd->fops = &sd_fops;
  	gd->private_data = &sdkp->driver;
  	gd->queue = sdkp->device->request_queue;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2957
2958
2959
2960
2961
  	/* defaults, until the device tells us otherwise */
  	sdp->sector_size = 512;
  	sdkp->capacity = 0;
  	sdkp->media_present = 1;
  	sdkp->write_prot = 0;
39c60a094   James Bottomley   [SCSI] sd: fix ar...
2962
  	sdkp->cache_override = 0;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2963
2964
2965
2966
  	sdkp->WCE = 0;
  	sdkp->RCD = 0;
  	sdkp->ATO = 0;
  	sdkp->first_scan = 1;
18a4d0a22   Martin K. Petersen   [SCSI] Handle dis...
2967
  	sdkp->max_medium_access_timeouts = SD_MAX_MEDIUM_TIMEOUTS;
70a9b8734   Martin K. Petersen   [SCSI] sd: Make r...
2968

4ace92fc1   Arjan van de Ven   fastboot: make sc...
2969
  	sd_revalidate_disk(gd);
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2970
  	gd->driverfs_dev = &sdp->sdev_gendev;
97fedbbe1   NeilBrown   Remove GENHD_FL_D...
2971
  	gd->flags = GENHD_FL_EXT_DEVT;
2bae0093c   Tejun Heo   [SCSI] sd: implem...
2972
  	if (sdp->removable) {
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2973
  		gd->flags |= GENHD_FL_REMOVABLE;
2bae0093c   Tejun Heo   [SCSI] sd: implem...
2974
2975
  		gd->events |= DISK_EVENT_MEDIA_CHANGE;
  	}
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2976

10c580e42   Aaron Lu   [SCSI] sd: call b...
2977
  	blk_pm_runtime_init(sdp->request_queue, dev);
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2978
  	add_disk(gd);
fe542396d   Martin K. Petersen   [SCSI] sd: Ensure...
2979
2980
  	if (sdkp->capacity)
  		sd_dif_config_host(sdkp);
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2981

3821d7689   Martin K. Petersen   sd: Detect non-ro...
2982
  	sd_revalidate_disk(gd);
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2983
2984
2985
  	sd_printk(KERN_NOTICE, sdkp, "Attached SCSI %sdisk
  ",
  		  sdp->removable ? "removable " : "");
478a8a054   Alan Stern   [SCSI] sd: add su...
2986
  	scsi_autopm_put_device(sdp);
ea038f63a   James Bottomley   [SCSI] fix oops d...
2987
  	put_device(&sdkp->dev);
4ace92fc1   Arjan van de Ven   fastboot: make sc...
2988
  }
3e1a7ff8a   Tejun Heo   block: allow disk...
2989
  /**
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
2990
2991
2992
2993
2994
2995
2996
2997
2998
2999
3000
3001
3002
3003
   *	sd_probe - called during driver initialization and whenever a
   *	new scsi device is attached to the system. It is called once
   *	for each scsi device (not just disks) present.
   *	@dev: pointer to device object
   *
   *	Returns 0 if successful (or not interested in this scsi device 
   *	(e.g. scanner)); 1 when there is an error.
   *
   *	Note: this function is invoked from the scsi mid-level.
   *	This function sets up the mapping between a given 
   *	<host,channel,id,lun> (found in sdp) and new device name 
   *	(e.g. /dev/sda). More precisely it is the block device major 
   *	and minor number that is chosen here.
   *
2db93ce8c   Petr Uzel   [SCSI] sd: make c...
3004
3005
   *	Assume sd_probe is not re-entrant (for time being)
   *	Also think about sd_probe() and sd_remove() running coincidentally.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3006
3007
3008
3009
3010
3011
   **/
  static int sd_probe(struct device *dev)
  {
  	struct scsi_device *sdp = to_scsi_device(dev);
  	struct scsi_disk *sdkp;
  	struct gendisk *gd;
439d77f70   H Hartley Sweeten   scsi/sd.c: quiet ...
3012
  	int index;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3013
  	int error;
6fe8c1dbe   Subhash Jadavani   scsi: balance out...
3014
  	scsi_autopm_get_device(sdp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3015
  	error = -ENODEV;
631e8a139   Al Viro   [SCSI] TYPE_RBC c...
3016
  	if (sdp->type != TYPE_DISK && sdp->type != TYPE_MOD && sdp->type != TYPE_RBC)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3017
  		goto out;
9ccfc756a   James Bottomley   [SCSI] move the m...
3018
  	SCSI_LOG_HLQUEUE(3, sdev_printk(KERN_INFO, sdp,
2db93ce8c   Petr Uzel   [SCSI] sd: make c...
3019
3020
  					"sd_probe
  "));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3021
3022
  
  	error = -ENOMEM;
24669f75a   Jes Sorensen   [SCSI] SCSI core ...
3023
  	sdkp = kzalloc(sizeof(*sdkp), GFP_KERNEL);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3024
3025
  	if (!sdkp)
  		goto out;
689d6fac4   Tejun Heo   block: replace @e...
3026
  	gd = alloc_disk(SD_MINORS);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3027
3028
  	if (!gd)
  		goto out_free;
f27bac276   Tejun Heo   [SCSI] sd: update...
3029
3030
3031
  	do {
  		if (!ida_pre_get(&sd_index_ida, GFP_KERNEL))
  			goto out_put;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3032

4034cc681   Tejun Heo   [SCSI] sd: revive...
3033
  		spin_lock(&sd_index_lock);
f27bac276   Tejun Heo   [SCSI] sd: update...
3034
  		error = ida_get_new(&sd_index_ida, &index);
4034cc681   Tejun Heo   [SCSI] sd: revive...
3035
  		spin_unlock(&sd_index_lock);
f27bac276   Tejun Heo   [SCSI] sd: update...
3036
  	} while (error == -EAGAIN);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3037

21208ae5a   Dave Kleikamp   [SCSI] sd: remove...
3038
3039
3040
  	if (error) {
  		sdev_printk(KERN_WARNING, sdp, "sd_probe: memory exhausted.
  ");
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3041
  		goto out_put;
1a03ae0f5   Michael Reed   [SCSI] sd name sp...
3042
  	}
3e1a7ff8a   Tejun Heo   block: allow disk...
3043
  	error = sd_format_disk_name("sd", index, gd->disk_name, DISK_NAME_LEN);
21208ae5a   Dave Kleikamp   [SCSI] sd: remove...
3044
3045
3046
  	if (error) {
  		sdev_printk(KERN_WARNING, sdp, "SCSI disk (sd) name length exceeded.
  ");
f27bac276   Tejun Heo   [SCSI] sd: update...
3047
  		goto out_free_index;
21208ae5a   Dave Kleikamp   [SCSI] sd: remove...
3048
  	}
f27bac276   Tejun Heo   [SCSI] sd: update...
3049

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3050
3051
3052
3053
  	sdkp->device = sdp;
  	sdkp->driver = &sd_template;
  	sdkp->disk = gd;
  	sdkp->index = index;
409f3499a   Arnd Bergmann   scsi/sd: remove b...
3054
  	atomic_set(&sdkp->openers, 0);
9e1a15376   Josh Hunt   [SCSI] properly i...
3055
  	atomic_set(&sdkp->device->ioerr_cnt, 0);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3056

601e76382   James Bottomley   [SCSI] sd: fix bu...
3057
3058
3059
3060
3061
3062
3063
3064
3065
  	if (!sdp->request_queue->rq_timeout) {
  		if (sdp->type != TYPE_MOD)
  			blk_queue_rq_timeout(sdp->request_queue, SD_TIMEOUT);
  		else
  			blk_queue_rq_timeout(sdp->request_queue,
  					     SD_MOD_TIMEOUT);
  	}
  
  	device_initialize(&sdkp->dev);
478a8a054   Alan Stern   [SCSI] sd: add su...
3066
  	sdkp->dev.parent = dev;
601e76382   James Bottomley   [SCSI] sd: fix bu...
3067
  	sdkp->dev.class = &sd_disk_class;
02aa2a376   Kees Cook   drivers: avoid fo...
3068
  	dev_set_name(&sdkp->dev, "%s", dev_name(dev));
601e76382   James Bottomley   [SCSI] sd: fix bu...
3069

dee0586e1   Dan Carpenter   sd: fix an error ...
3070
3071
  	error = device_add(&sdkp->dev);
  	if (error)
601e76382   James Bottomley   [SCSI] sd: fix bu...
3072
  		goto out_free_index;
478a8a054   Alan Stern   [SCSI] sd: add su...
3073
3074
  	get_device(dev);
  	dev_set_drvdata(dev, sdkp);
601e76382   James Bottomley   [SCSI] sd: fix bu...
3075

ea038f63a   James Bottomley   [SCSI] fix oops d...
3076
  	get_device(&sdkp->dev);	/* prevent release before async_schedule */
a7a20d103   Dan Williams   [SCSI] sd: limit ...
3077
  	async_schedule_domain(sd_probe_async, sdkp, &scsi_sd_probe_domain);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3078
3079
  
  	return 0;
f27bac276   Tejun Heo   [SCSI] sd: update...
3080
   out_free_index:
4034cc681   Tejun Heo   [SCSI] sd: revive...
3081
  	spin_lock(&sd_index_lock);
f27bac276   Tejun Heo   [SCSI] sd: update...
3082
  	ida_remove(&sd_index_ida, index);
4034cc681   Tejun Heo   [SCSI] sd: revive...
3083
  	spin_unlock(&sd_index_lock);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
3084
   out_put:
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3085
  	put_disk(gd);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
3086
   out_free:
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3087
  	kfree(sdkp);
6bdaa1f17   James Bottomley   [SCSI] allow disp...
3088
   out:
6fe8c1dbe   Subhash Jadavani   scsi: balance out...
3089
  	scsi_autopm_put_device(sdp);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3090
3091
3092
3093
3094
3095
3096
3097
3098
3099
3100
3101
3102
3103
3104
3105
  	return error;
  }
  
  /**
   *	sd_remove - called whenever a scsi disk (previously recognized by
   *	sd_probe) is detached from the system. It is called (potentially
   *	multiple times) during sd module unload.
   *	@sdp: pointer to mid level scsi device object
   *
   *	Note: this function is invoked from the scsi mid-level.
   *	This function potentially frees up a device name (e.g. /dev/sdc)
   *	that could be re-used by a subsequent sd_probe().
   *	This function is not called when the built-in sd driver is "exit-ed".
   **/
  static int sd_remove(struct device *dev)
  {
601e76382   James Bottomley   [SCSI] sd: fix bu...
3106
  	struct scsi_disk *sdkp;
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3107
  	dev_t devt;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3108

601e76382   James Bottomley   [SCSI] sd: fix bu...
3109
  	sdkp = dev_get_drvdata(dev);
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3110
  	devt = disk_devt(sdkp->disk);
478a8a054   Alan Stern   [SCSI] sd: add su...
3111
  	scsi_autopm_get_device(sdkp->device);
3c31b52f9   Dan Williams   scsi: async sd re...
3112
  	async_synchronize_full_domain(&scsi_sd_pm_domain);
a7a20d103   Dan Williams   [SCSI] sd: limit ...
3113
  	async_synchronize_full_domain(&scsi_sd_probe_domain);
ee959b00c   Tony Jones   SCSI: convert str...
3114
  	device_del(&sdkp->dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3115
3116
  	del_gendisk(sdkp->disk);
  	sd_shutdown(dev);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
3117

0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3118
3119
  	blk_register_region(devt, SD_MINORS, NULL,
  			    sd_default_probe, NULL, NULL);
0b9506723   Arjan van de Ven   [SCSI] turn most ...
3120
  	mutex_lock(&sd_ref_mutex);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
3121
  	dev_set_drvdata(dev, NULL);
ee959b00c   Tony Jones   SCSI: convert str...
3122
  	put_device(&sdkp->dev);
0b9506723   Arjan van de Ven   [SCSI] turn most ...
3123
  	mutex_unlock(&sd_ref_mutex);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3124
3125
3126
3127
3128
3129
  
  	return 0;
  }
  
  /**
   *	scsi_disk_release - Called to free the scsi_disk structure
ee959b00c   Tony Jones   SCSI: convert str...
3130
   *	@dev: pointer to embedded class device
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3131
   *
0b9506723   Arjan van de Ven   [SCSI] turn most ...
3132
   *	sd_ref_mutex must be held entering this routine.  Because it is
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3133
3134
   *	called on last put, you should always use the scsi_disk_get()
   *	scsi_disk_put() helpers which manipulate the semaphore directly
ee959b00c   Tony Jones   SCSI: convert str...
3135
   *	and never do a direct put_device.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3136
   **/
ee959b00c   Tony Jones   SCSI: convert str...
3137
  static void scsi_disk_release(struct device *dev)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3138
  {
ee959b00c   Tony Jones   SCSI: convert str...
3139
  	struct scsi_disk *sdkp = to_scsi_disk(dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3140
3141
  	struct gendisk *disk = sdkp->disk;
  	
4034cc681   Tejun Heo   [SCSI] sd: revive...
3142
  	spin_lock(&sd_index_lock);
f27bac276   Tejun Heo   [SCSI] sd: update...
3143
  	ida_remove(&sd_index_ida, sdkp->index);
4034cc681   Tejun Heo   [SCSI] sd: revive...
3144
  	spin_unlock(&sd_index_lock);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3145
3146
  
  	disk->private_data = NULL;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3147
  	put_disk(disk);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
3148
  	put_device(&sdkp->device->sdev_gendev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3149
3150
3151
  
  	kfree(sdkp);
  }
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3152
  static int sd_start_stop_device(struct scsi_disk *sdkp, int start)
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3153
3154
3155
  {
  	unsigned char cmd[6] = { START_STOP };	/* START_VALID */
  	struct scsi_sense_hdr sshdr;
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3156
  	struct scsi_device *sdp = sdkp->device;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3157
3158
3159
3160
  	int res;
  
  	if (start)
  		cmd[4] |= 1;	/* START */
d2886ea36   Stefan Richter   scsi: sd: optiona...
3161
3162
  	if (sdp->start_stop_pwr_cond)
  		cmd[4] |= start ? 1 << 4 : 3 << 4;	/* Active or Standby */
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3163
3164
  	if (!scsi_device_online(sdp))
  		return -ENODEV;
9b21493c4   Lin Ming   [SCSI] sd: use RE...
3165
3166
  	res = scsi_execute_req_flags(sdp, cmd, DMA_NONE, NULL, 0, &sshdr,
  			       SD_TIMEOUT, SD_MAX_RETRIES, NULL, REQ_PM);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3167
  	if (res) {
ef61329db   Hannes Reinecke   scsi: remove scsi...
3168
  		sd_print_result(sdkp, "Start/Stop Unit failed", res);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3169
  		if (driver_byte(res) & DRIVER_SENSE)
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3170
  			sd_print_sense_hdr(sdkp, &sshdr);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3171
3172
3173
3174
  		if (scsi_sense_valid(&sshdr) &&
  			/* 0x3a is medium not present */
  			sshdr.asc == 0x3a)
  			res = 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3175
  	}
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3176
3177
3178
3179
3180
  	/* SCSI error codes must not go to the generic layer */
  	if (res)
  		return -EIO;
  
  	return 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3181
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3182
3183
3184
3185
3186
3187
3188
  /*
   * Send a SYNCHRONIZE CACHE instruction down to the device through
   * the normal SCSI command structure.  Wait for the command to
   * complete.
   */
  static void sd_shutdown(struct device *dev)
  {
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3189
  	struct scsi_disk *sdkp = dev_get_drvdata(dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3190
3191
3192
  
  	if (!sdkp)
  		return;         /* this can happen */
54f575884   Lin Ming   [SCSI] sd: check ...
3193
  	if (pm_runtime_suspended(dev))
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3194
  		return;
54f575884   Lin Ming   [SCSI] sd: check ...
3195

95897910a   Oliver Neukum   [SCSI] sd: Add er...
3196
  	if (sdkp->WCE && sdkp->media_present) {
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
3197
3198
3199
  		sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache
  ");
  		sd_sync_cache(sdkp);
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
3200
  	}
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3201

cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3202
3203
3204
3205
  	if (system_state != SYSTEM_RESTART && sdkp->device->manage_start_stop) {
  		sd_printk(KERN_NOTICE, sdkp, "Stopping disk
  ");
  		sd_start_stop_device(sdkp, 0);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3206
  	}
39b7f1e25   Alan Stern   [SCSI] sd: Fix re...
3207
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3208

95897910a   Oliver Neukum   [SCSI] sd: Add er...
3209
  static int sd_suspend_common(struct device *dev, bool ignore_stop_errors)
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3210
  {
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3211
  	struct scsi_disk *sdkp = dev_get_drvdata(dev);
09ff92fea   Alan Stern   [SCSI] sd: fix re...
3212
  	int ret = 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3213

13b438914   Alan Stern   SCSI: fix crashes...
3214
3215
  	if (!sdkp)	/* E.g.: runtime suspend following sd_remove() */
  		return 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3216

95897910a   Oliver Neukum   [SCSI] sd: Add er...
3217
  	if (sdkp->WCE && sdkp->media_present) {
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3218
3219
  		sd_printk(KERN_NOTICE, sdkp, "Synchronizing SCSI cache
  ");
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3220
  		ret = sd_sync_cache(sdkp);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3221
3222
3223
3224
  		if (ret) {
  			/* ignore OFFLINE device */
  			if (ret == -ENODEV)
  				ret = 0;
09ff92fea   Alan Stern   [SCSI] sd: fix re...
3225
  			goto done;
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3226
  		}
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3227
  	}
691e3d317   Aaron Lu   [SCSI] sd: update...
3228
  	if (sdkp->device->manage_start_stop) {
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3229
3230
  		sd_printk(KERN_NOTICE, sdkp, "Stopping disk
  ");
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3231
  		/* an error is not worth aborting a system sleep */
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3232
  		ret = sd_start_stop_device(sdkp, 0);
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3233
3234
  		if (ignore_stop_errors)
  			ret = 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3235
  	}
09ff92fea   Alan Stern   [SCSI] sd: fix re...
3236
  done:
09ff92fea   Alan Stern   [SCSI] sd: fix re...
3237
  	return ret;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3238
  }
95897910a   Oliver Neukum   [SCSI] sd: Add er...
3239
3240
3241
3242
3243
3244
3245
3246
3247
  static int sd_suspend_system(struct device *dev)
  {
  	return sd_suspend_common(dev, true);
  }
  
  static int sd_suspend_runtime(struct device *dev)
  {
  	return sd_suspend_common(dev, false);
  }
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3248
3249
  static int sd_resume(struct device *dev)
  {
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3250
  	struct scsi_disk *sdkp = dev_get_drvdata(dev);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3251

13b438914   Alan Stern   SCSI: fix crashes...
3252
3253
  	if (!sdkp)	/* E.g.: runtime resume at the start of sd_probe() */
  		return 0;
cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3254
  	if (!sdkp->device->manage_start_stop)
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3255
  		return 0;
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3256

cc5d2c8c6   James Bottomley   [SCSI] sd: fix up...
3257
3258
  	sd_printk(KERN_NOTICE, sdkp, "Starting disk
  ");
3d9a1f530   Christoph Hellwig   sd: don't grab a ...
3259
  	return sd_start_stop_device(sdkp, 1);
c3c94c5a2   Tejun Heo   [SCSI] sd: implem...
3260
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3261
3262
3263
3264
3265
3266
3267
3268
  /**
   *	init_sd - entry point for this driver (both when built in or when
   *	a module).
   *
   *	Note: this function registers this driver with the scsi mid-level.
   **/
  static int __init init_sd(void)
  {
5e4009ba3   Jeff Garzik   [SCSI] SCSI sd: f...
3269
  	int majors = 0, i, err;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3270
3271
3272
  
  	SCSI_LOG_HLQUEUE(3, printk("init_sd: sd driver entry point
  "));
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3273
3274
3275
3276
3277
3278
3279
  	for (i = 0; i < SD_MAJORS; i++) {
  		if (register_blkdev(sd_major(i), "sd") != 0)
  			continue;
  		majors++;
  		blk_register_region(sd_major(i), SD_MINORS, NULL,
  				    sd_default_probe, NULL, NULL);
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3280
3281
3282
  
  	if (!majors)
  		return -ENODEV;
5e4009ba3   Jeff Garzik   [SCSI] SCSI sd: f...
3283
3284
3285
  	err = class_register(&sd_disk_class);
  	if (err)
  		goto err_out;
6bdaa1f17   James Bottomley   [SCSI] allow disp...
3286

4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
3287
3288
3289
3290
3291
  	sd_cdb_cache = kmem_cache_create("sd_ext_cdb", SD_EXT_CDB_SIZE,
  					 0, 0, NULL);
  	if (!sd_cdb_cache) {
  		printk(KERN_ERR "sd: can't init extended cdb cache
  ");
8d964478b   Clément Calmels   sd: bad return co...
3292
  		err = -ENOMEM;
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
3293
3294
3295
3296
3297
3298
3299
  		goto err_out_class;
  	}
  
  	sd_cdb_pool = mempool_create_slab_pool(SD_MEMPOOL_SIZE, sd_cdb_cache);
  	if (!sd_cdb_pool) {
  		printk(KERN_ERR "sd: can't init extended cdb pool
  ");
8d964478b   Clément Calmels   sd: bad return co...
3300
  		err = -ENOMEM;
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
3301
3302
  		goto err_out_cache;
  	}
afd5e34b2   Joel D. Diaz   [SCSI] sd: Reshuf...
3303
3304
3305
  	err = scsi_register_driver(&sd_template.gendrv);
  	if (err)
  		goto err_out_driver;
5e4009ba3   Jeff Garzik   [SCSI] SCSI sd: f...
3306
  	return 0;
afd5e34b2   Joel D. Diaz   [SCSI] sd: Reshuf...
3307
3308
  err_out_driver:
  	mempool_destroy(sd_cdb_pool);
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
3309
3310
  err_out_cache:
  	kmem_cache_destroy(sd_cdb_cache);
5e4009ba3   Jeff Garzik   [SCSI] SCSI sd: f...
3311
3312
3313
3314
3315
3316
  err_out_class:
  	class_unregister(&sd_disk_class);
  err_out:
  	for (i = 0; i < SD_MAJORS; i++)
  		unregister_blkdev(sd_major(i), "sd");
  	return err;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3317
3318
3319
3320
3321
3322
3323
3324
3325
3326
3327
3328
3329
  }
  
  /**
   *	exit_sd - exit point for this driver (when it is a module).
   *
   *	Note: this function unregisters this driver from the scsi mid-level.
   **/
  static void __exit exit_sd(void)
  {
  	int i;
  
  	SCSI_LOG_HLQUEUE(3, printk("exit_sd: exiting sd driver
  "));
afd5e34b2   Joel D. Diaz   [SCSI] sd: Reshuf...
3330
  	scsi_unregister_driver(&sd_template.gendrv);
4e7392ec5   Martin K. Petersen   [SCSI] sd: Suppor...
3331
3332
  	mempool_destroy(sd_cdb_pool);
  	kmem_cache_destroy(sd_cdb_cache);
5e4009ba3   Jeff Garzik   [SCSI] SCSI sd: f...
3333
  	class_unregister(&sd_disk_class);
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3334
3335
  	for (i = 0; i < SD_MAJORS; i++) {
  		blk_unregister_region(sd_major(i), SD_MINORS);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3336
  		unregister_blkdev(sd_major(i), "sd");
0761df9c4   Hannes Reinecke   [SCSI] sd: avoid ...
3337
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3338
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
3339
3340
  module_init(init_sd);
  module_exit(exit_sd);
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
3341
3342
3343
3344
  
  static void sd_print_sense_hdr(struct scsi_disk *sdkp,
  			       struct scsi_sense_hdr *sshdr)
  {
210455196   Hannes Reinecke   scsi: use per-cpu...
3345
3346
  	scsi_print_sense_hdr(sdkp->device,
  			     sdkp->disk ? sdkp->disk->disk_name : NULL, sshdr);
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
3347
  }
ef61329db   Hannes Reinecke   scsi: remove scsi...
3348
3349
  static void sd_print_result(const struct scsi_disk *sdkp, const char *msg,
  			    int result)
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
3350
  {
ef61329db   Hannes Reinecke   scsi: remove scsi...
3351
3352
3353
3354
3355
3356
3357
3358
3359
3360
3361
3362
3363
3364
  	const char *hb_string = scsi_hostbyte_string(result);
  	const char *db_string = scsi_driverbyte_string(result);
  
  	if (hb_string || db_string)
  		sd_printk(KERN_INFO, sdkp,
  			  "%s: Result: hostbyte=%s driverbyte=%s
  ", msg,
  			  hb_string ? hb_string : "invalid",
  			  db_string ? db_string : "invalid");
  	else
  		sd_printk(KERN_INFO, sdkp,
  			  "%s: Result: hostbyte=0x%02x driverbyte=0x%02x
  ",
  			  msg, host_byte(result), driver_byte(result));
e73aec824   Martin K. Petersen   [SCSI] sd: make p...
3365
  }