]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/scsi/scsi_debug.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'trace-3.15' of git://git.kernel.org/pub/scm/linux/kernel/git/rostedt/linux...
[mirror_ubuntu-bionic-kernel.git] / drivers / scsi / scsi_debug.c
CommitLineData
1da177e4 1/*
1da177e4
LT		 2 * vvvvvvvvvvvvvvvvvvvvvvv Original vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
3 * Copyright (C) 1992 Eric Youngdale
4 * Simulate a host adapter with 2 disks attached. Do a lot of checking
5 * to make sure that we are not getting blocks mixed up, and PANIC if
6 * anything out of the ordinary is seen.
7 * ^^^^^^^^^^^^^^^^^^^^^^^ Original ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
8 *
9 * This version is more generic, simulating a variable number of disk
23183910
DG		 10 * (or disk like devices) sharing a common amount of RAM. To be more
11 * realistic, the simulated devices have the transport attributes of
12 * SAS disks.
1da177e4
LT		 13 *
14 *
78d4e5a0 15 * For documentation see http://sg.danny.cz/sg/sdebug26.html
1da177e4
LT		 16 *
17 * D. Gilbert (dpg) work for Magneto-Optical device test [20010421]
18 * dpg: work for devfs large number of disks [20010809]
19 * forked for lk 2.5 series [20011216, 20020101]
20 * use vmalloc() more inquiry+mode_sense [20020302]
21 * add timers for delayed responses [20020721]
22 * Patrick Mansfield <patmans@us.ibm.com> max_luns+scsi_level [20021031]
23 * Mike Anderson <andmike@us.ibm.com> sysfs work [20021118]
24 * dpg: change style of boot options to "scsi_debug.num_tgts=2" and
25 * module options to "modprobe scsi_debug num_tgts=2" [20021221]
26 */
27
1da177e4
LT		 28#include <linux/module.h>
29
30#include <linux/kernel.h>
1da177e4
LT		 31#include <linux/errno.h>
32#include <linux/timer.h>
5a0e3ad6 33#include <linux/slab.h>
1da177e4
LT		 34#include <linux/types.h>
35#include <linux/string.h>
36#include <linux/genhd.h>
37#include <linux/fs.h>
38#include <linux/init.h>
39#include <linux/proc_fs.h>
1da177e4
LT		 40#include <linux/vmalloc.h>
41#include <linux/moduleparam.h>
852e034d 42#include <linux/scatterlist.h>
1da177e4 43#include <linux/blkdev.h>
c6a44287
MP		 44#include <linux/crc-t10dif.h>
45
46#include <net/checksum.h>
9ff26eef 47
44d92694
MP		 48#include <asm/unaligned.h>
49
9ff26eef
FT		 50#include <scsi/scsi.h>
51#include <scsi/scsi_cmnd.h>
52#include <scsi/scsi_device.h>
1da177e4
LT		 53#include <scsi/scsi_host.h>
54#include <scsi/scsicam.h>
a34c4e98 55#include <scsi/scsi_eh.h>
395cef03 56#include <scsi/scsi_dbg.h>
1da177e4 57
c6a44287 58#include "sd.h"
1da177e4 59#include "scsi_logging.h"
1da177e4 60
78d4e5a0
DG		 61#define SCSI_DEBUG_VERSION "1.82"
62static const char * scsi_debug_version_date = "20100324";
1da177e4 63
6f3cbf55 64/* Additional Sense Code (ASC) */
c65b1445
DG		 65#define NO_ADDITIONAL_SENSE 0x0
66#define LOGICAL_UNIT_NOT_READY 0x4
c5af0db9 67#define LOGICAL_UNIT_COMMUNICATION_FAILURE 0x8
1da177e4 68#define UNRECOVERED_READ_ERR 0x11
c65b1445 69#define PARAMETER_LIST_LENGTH_ERR 0x1a
1da177e4
LT		 70#define INVALID_OPCODE 0x20
71#define ADDR_OUT_OF_RANGE 0x21
395cef03 72#define INVALID_COMMAND_OPCODE 0x20
1da177e4 73#define INVALID_FIELD_IN_CDB 0x24
c65b1445 74#define INVALID_FIELD_IN_PARAM_LIST 0x26
1da177e4
LT		 75#define POWERON_RESET 0x29
76#define SAVING_PARAMS_UNSUP 0x39
6f3cbf55 77#define TRANSPORT_PROBLEM 0x4b
c65b1445
DG		 78#define THRESHOLD_EXCEEDED 0x5d
79#define LOW_POWER_COND_ON 0x5e
1da177e4 80
6f3cbf55
DG		 81/* Additional Sense Code Qualifier (ASCQ) */
82#define ACK_NAK_TO 0x3
83
1da177e4
LT		 84#define SDEBUG_TAGGED_QUEUING 0 /* 0 | MSG_SIMPLE_TAG | MSG_ORDERED_TAG */
85
86/* Default values for driver parameters */
87#define DEF_NUM_HOST 1
88#define DEF_NUM_TGTS 1
89#define DEF_MAX_LUNS 1
90/* With these defaults, this driver will make 1 host with 1 target
91 * (id 0) containing 1 logical unit (lun 0). That is 1 device.
92 */
5b94e232 93#define DEF_ATO 1
1da177e4
LT		 94#define DEF_DELAY 1
95#define DEF_DEV_SIZE_MB 8
5b94e232
MP		 96#define DEF_DIF 0
97#define DEF_DIX 0
1da177e4 98#define DEF_D_SENSE 0
5b94e232 99#define DEF_EVERY_NTH 0
23183910 100#define DEF_FAKE_RW 0
c6a44287 101#define DEF_GUARD 0
5b94e232
MP		 102#define DEF_LBPU 0
103#define DEF_LBPWS 0
104#define DEF_LBPWS10 0
be1dd78d 105#define DEF_LBPRZ 1
ea61fca5 106#define DEF_LOWEST_ALIGNED 0
5b94e232
MP		 107#define DEF_NO_LUN_0 0
108#define DEF_NUM_PARTS 0
109#define DEF_OPTS 0
e308b3d1 110#define DEF_OPT_BLKS 64
5b94e232
MP		 111#define DEF_PHYSBLK_EXP 0
112#define DEF_PTYPE 0
d986788b 113#define DEF_REMOVABLE false
5b94e232
MP		 114#define DEF_SCSI_LEVEL 5 /* INQUIRY, byte2 [5->SPC-3] */
115#define DEF_SECTOR_SIZE 512
116#define DEF_UNMAP_ALIGNMENT 0
117#define DEF_UNMAP_GRANULARITY 1
6014759c
MP		 118#define DEF_UNMAP_MAX_BLOCKS 0xFFFFFFFF
119#define DEF_UNMAP_MAX_DESC 256
5b94e232
MP		 120#define DEF_VIRTUAL_GB 0
121#define DEF_VPD_USE_HOSTNO 1
122#define DEF_WRITESAME_LENGTH 0xFFFF
1da177e4
LT		 123
124/* bit mask values for scsi_debug_opts */
125#define SCSI_DEBUG_OPT_NOISE 1
126#define SCSI_DEBUG_OPT_MEDIUM_ERR 2
127#define SCSI_DEBUG_OPT_TIMEOUT 4
128#define SCSI_DEBUG_OPT_RECOVERED_ERR 8
6f3cbf55 129#define SCSI_DEBUG_OPT_TRANSPORT_ERR 16
c6a44287
MP		 130#define SCSI_DEBUG_OPT_DIF_ERR 32
131#define SCSI_DEBUG_OPT_DIX_ERR 64
18a4d0a2 132#define SCSI_DEBUG_OPT_MAC_TIMEOUT 128
1da177e4
LT		 133/* When "every_nth" > 0 then modulo "every_nth" commands:
134 * - a no response is simulated if SCSI_DEBUG_OPT_TIMEOUT is set
135 * - a RECOVERED_ERROR is simulated on successful read and write
136 * commands if SCSI_DEBUG_OPT_RECOVERED_ERR is set.
6f3cbf55
DG		 137 * - a TRANSPORT_ERROR is simulated on successful read and write
138 * commands if SCSI_DEBUG_OPT_TRANSPORT_ERR is set.
1da177e4
LT		 139 *
140 * When "every_nth" < 0 then after "- every_nth" commands:
141 * - a no response is simulated if SCSI_DEBUG_OPT_TIMEOUT is set
142 * - a RECOVERED_ERROR is simulated on successful read and write
143 * commands if SCSI_DEBUG_OPT_RECOVERED_ERR is set.
6f3cbf55
DG		 144 * - a TRANSPORT_ERROR is simulated on successful read and write
145 * commands if SCSI_DEBUG_OPT_TRANSPORT_ERR is set.
1da177e4
LT		 146 * This will continue until some other action occurs (e.g. the user
147 * writing a new value (other than -1 or 1) to every_nth via sysfs).
148 */
149
150/* when 1==SCSI_DEBUG_OPT_MEDIUM_ERR, a medium error is simulated at this
151 * sector on read commands: */
152#define OPT_MEDIUM_ERR_ADDR 0x1234 /* that's sector 4660 in decimal */
32f7ef73 153#define OPT_MEDIUM_ERR_NUM 10 /* number of consecutive medium errs */
1da177e4
LT		 154
155/* If REPORT LUNS has luns >= 256 it can choose "flat space" (value 1)
156 * or "peripheral device" addressing (value 0) */
157#define SAM2_LUN_ADDRESS_METHOD 0
c65b1445 158#define SAM2_WLUN_REPORT_LUNS 0xc101
1da177e4 159
78d4e5a0
DG		 160/* Can queue up to this number of commands. Typically commands that
161 * that have a non-zero delay are queued. */
162#define SCSI_DEBUG_CANQUEUE 255
163
1da177e4 164static int scsi_debug_add_host = DEF_NUM_HOST;
5b94e232 165static int scsi_debug_ato = DEF_ATO;
1da177e4
LT		 166static int scsi_debug_delay = DEF_DELAY;
167static int scsi_debug_dev_size_mb = DEF_DEV_SIZE_MB;
5b94e232
MP		 168static int scsi_debug_dif = DEF_DIF;
169static int scsi_debug_dix = DEF_DIX;
170static int scsi_debug_dsense = DEF_D_SENSE;
1da177e4 171static int scsi_debug_every_nth = DEF_EVERY_NTH;
5b94e232 172static int scsi_debug_fake_rw = DEF_FAKE_RW;
68aee7ba 173static unsigned int scsi_debug_guard = DEF_GUARD;
5b94e232 174static int scsi_debug_lowest_aligned = DEF_LOWEST_ALIGNED;
1da177e4 175static int scsi_debug_max_luns = DEF_MAX_LUNS;
78d4e5a0 176static int scsi_debug_max_queue = SCSI_DEBUG_CANQUEUE;
5b94e232 177static int scsi_debug_no_lun_0 = DEF_NO_LUN_0;
78d4e5a0 178static int scsi_debug_no_uld = 0;
5b94e232 179static int scsi_debug_num_parts = DEF_NUM_PARTS;
1da177e4 180static int scsi_debug_num_tgts = DEF_NUM_TGTS; /* targets per host */
5b94e232 181static int scsi_debug_opt_blks = DEF_OPT_BLKS;
1da177e4 182static int scsi_debug_opts = DEF_OPTS;
5b94e232 183static int scsi_debug_physblk_exp = DEF_PHYSBLK_EXP;
1da177e4 184static int scsi_debug_ptype = DEF_PTYPE; /* SCSI peripheral type (0==disk) */
5b94e232
MP		 185static int scsi_debug_scsi_level = DEF_SCSI_LEVEL;
186static int scsi_debug_sector_size = DEF_SECTOR_SIZE;
c65b1445 187static int scsi_debug_virtual_gb = DEF_VIRTUAL_GB;
23183910 188static int scsi_debug_vpd_use_hostno = DEF_VPD_USE_HOSTNO;
5b94e232
MP		 189static unsigned int scsi_debug_lbpu = DEF_LBPU;
190static unsigned int scsi_debug_lbpws = DEF_LBPWS;
191static unsigned int scsi_debug_lbpws10 = DEF_LBPWS10;
be1dd78d 192static unsigned int scsi_debug_lbprz = DEF_LBPRZ;
6014759c 193static unsigned int scsi_debug_unmap_alignment = DEF_UNMAP_ALIGNMENT;
5b94e232
MP		 194static unsigned int scsi_debug_unmap_granularity = DEF_UNMAP_GRANULARITY;
195static unsigned int scsi_debug_unmap_max_blocks = DEF_UNMAP_MAX_BLOCKS;
196static unsigned int scsi_debug_unmap_max_desc = DEF_UNMAP_MAX_DESC;
197static unsigned int scsi_debug_write_same_length = DEF_WRITESAME_LENGTH;
d986788b 198static bool scsi_debug_removable = DEF_REMOVABLE;
0759c666 199static bool scsi_debug_clustering;
1da177e4
LT		 200
201static int scsi_debug_cmnd_count = 0;
202
203#define DEV_READONLY(TGT) (0)
1da177e4 204
c65b1445 205static unsigned int sdebug_store_sectors;
1da177e4
LT		 206static sector_t sdebug_capacity; /* in sectors */
207
208/* old BIOS stuff, kernel may get rid of them but some mode sense pages
209 may still need them */
210static int sdebug_heads; /* heads per disk */
211static int sdebug_cylinders_per; /* cylinders per surface */
212static int sdebug_sectors_per; /* sectors per cylinder */
213
1da177e4
LT		 214#define SDEBUG_MAX_PARTS 4
215
216#define SDEBUG_SENSE_LEN 32
217
395cef03 218#define SCSI_DEBUG_MAX_CMD_LEN 32
9e603ca0 219
5b94e232
MP		 220static unsigned int scsi_debug_lbp(void)
221{
222 return scsi_debug_lbpu | scsi_debug_lbpws | scsi_debug_lbpws10;
223}
224
1da177e4
LT		 225struct sdebug_dev_info {
226 struct list_head dev_list;
227 unsigned char sense_buff[SDEBUG_SENSE_LEN]; /* weak nexus */
228 unsigned int channel;
229 unsigned int target;
230 unsigned int lun;
231 struct sdebug_host_info *sdbg_host;
c65b1445 232 unsigned int wlun;
1da177e4 233 char reset;
c65b1445 234 char stopped;
1da177e4
LT		 235 char used;
236};
237
238struct sdebug_host_info {
239 struct list_head host_list;
240 struct Scsi_Host *shost;
241 struct device dev;
242 struct list_head dev_info_list;
243};
244
245#define to_sdebug_host(d) \
246 container_of(d, struct sdebug_host_info, dev)
247
248static LIST_HEAD(sdebug_host_list);
249static DEFINE_SPINLOCK(sdebug_host_list_lock);
250
251typedef void (* done_funct_t) (struct scsi_cmnd *);
252
253struct sdebug_queued_cmd {
254 int in_use;
255 struct timer_list cmnd_timer;
256 done_funct_t done_funct;
257 struct scsi_cmnd * a_cmnd;
258 int scsi_result;
259};
260static struct sdebug_queued_cmd queued_arr[SCSI_DEBUG_CANQUEUE];
261
1da177e4 262static unsigned char * fake_storep; /* ramdisk storage */
e18d8bea 263static struct sd_dif_tuple *dif_storep; /* protection info */
44d92694 264static void *map_storep; /* provisioning map */
1da177e4 265
44d92694 266static unsigned long map_size;
1da177e4
LT		 267static int num_aborts = 0;
268static int num_dev_resets = 0;
269static int num_bus_resets = 0;
270static int num_host_resets = 0;
c6a44287
MP		 271static int dix_writes;
272static int dix_reads;
273static int dif_errors;
1da177e4
LT		 274
275static DEFINE_SPINLOCK(queued_arr_lock);
276static DEFINE_RWLOCK(atomic_rw);
277
278static char sdebug_proc_name[] = "scsi_debug";
279
1da177e4
LT		 280static struct bus_type pseudo_lld_bus;
281
282static struct device_driver sdebug_driverfs_driver = {
283 .name = sdebug_proc_name,
284 .bus = &pseudo_lld_bus,
1da177e4
LT		 285};
286
287static const int check_condition_result =
288 (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
289
c6a44287
MP		 290static const int illegal_condition_result =
291 (DRIVER_SENSE << 24) | (DID_ABORT << 16) | SAM_STAT_CHECK_CONDITION;
292
c65b1445
DG		 293static unsigned char ctrl_m_pg[] = {0xa, 10, 2, 0, 0, 0, 0, 0,
294 0, 0, 0x2, 0x4b};
295static unsigned char iec_m_pg[] = {0x1c, 0xa, 0x08, 0, 0, 0, 0, 0,
296 0, 0, 0x0, 0x0};
297
14faa944
AM		 298static void *fake_store(unsigned long long lba)
299{
300 lba = do_div(lba, sdebug_store_sectors);
301
302 return fake_storep + lba * scsi_debug_sector_size;
303}
304
305static struct sd_dif_tuple *dif_store(sector_t sector)
306{
307 sector = do_div(sector, sdebug_store_sectors);
308
309 return dif_storep + sector;
310}
311
1da177e4
LT		 312static int sdebug_add_adapter(void);
313static void sdebug_remove_adapter(void);
1da177e4 314
8dea0d02
FT		 315static void sdebug_max_tgts_luns(void)
316{
317 struct sdebug_host_info *sdbg_host;
318 struct Scsi_Host *hpnt;
319
320 spin_lock(&sdebug_host_list_lock);
321 list_for_each_entry(sdbg_host, &sdebug_host_list, host_list) {
322 hpnt = sdbg_host->shost;
323 if ((hpnt->this_id >= 0) &&
324 (scsi_debug_num_tgts > hpnt->this_id))
325 hpnt->max_id = scsi_debug_num_tgts + 1;
326 else
327 hpnt->max_id = scsi_debug_num_tgts;
328 /* scsi_debug_max_luns; */
329 hpnt->max_lun = SAM2_WLUN_REPORT_LUNS;
330 }
331 spin_unlock(&sdebug_host_list_lock);
332}
333
334static void mk_sense_buffer(struct sdebug_dev_info *devip, int key,
335 int asc, int asq)
336{
337 unsigned char *sbuff;
338
339 sbuff = devip->sense_buff;
340 memset(sbuff, 0, SDEBUG_SENSE_LEN);
341
342 scsi_build_sense_buffer(scsi_debug_dsense, sbuff, key, asc, asq);
343
344 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
345 printk(KERN_INFO "scsi_debug: [sense_key,asc,ascq]: "
346 "[0x%x,0x%x,0x%x]\n", key, asc, asq);
347}
1da177e4 348
3de9f944 349static void get_data_transfer_info(unsigned char *cmd,
395cef03
MP		 350 unsigned long long *lba, unsigned int *num,
351 u32 *ei_lba)
3de9f944 352{
395cef03
MP		 353 *ei_lba = 0;
354
3de9f944 355 switch (*cmd) {
395cef03
MP		 356 case VARIABLE_LENGTH_CMD:
357 *lba = (u64)cmd[19] | (u64)cmd[18] << 8 |
358 (u64)cmd[17] << 16 | (u64)cmd[16] << 24 |
359 (u64)cmd[15] << 32 | (u64)cmd[14] << 40 |
360 (u64)cmd[13] << 48 | (u64)cmd[12] << 56;
361
362 *ei_lba = (u32)cmd[23] | (u32)cmd[22] << 8 |
363 (u32)cmd[21] << 16 | (u32)cmd[20] << 24;
364
365 *num = (u32)cmd[31] | (u32)cmd[30] << 8 | (u32)cmd[29] << 16 |
366 (u32)cmd[28] << 24;
367 break;
368
44d92694 369 case WRITE_SAME_16:
3de9f944
FT		 370 case WRITE_16:
371 case READ_16:
d5cdc989
FT		 372 *lba = (u64)cmd[9] | (u64)cmd[8] << 8 |
373 (u64)cmd[7] << 16 | (u64)cmd[6] << 24 |
374 (u64)cmd[5] << 32 | (u64)cmd[4] << 40 |
375 (u64)cmd[3] << 48 | (u64)cmd[2] << 56;
376
377 *num = (u32)cmd[13] | (u32)cmd[12] << 8 | (u32)cmd[11] << 16 |
378 (u32)cmd[10] << 24;
3de9f944
FT		 379 break;
380 case WRITE_12:
381 case READ_12:
d5cdc989
FT		 382 *lba = (u32)cmd[5] | (u32)cmd[4] << 8 | (u32)cmd[3] << 16 |
383 (u32)cmd[2] << 24;
384
385 *num = (u32)cmd[9] | (u32)cmd[8] << 8 | (u32)cmd[7] << 16 |
386 (u32)cmd[6] << 24;
3de9f944 387 break;
44d92694 388 case WRITE_SAME:
3de9f944
FT		 389 case WRITE_10:
390 case READ_10:
c639d14e 391 case XDWRITEREAD_10:
d5cdc989
FT		 392 *lba = (u32)cmd[5] | (u32)cmd[4] << 8 | (u32)cmd[3] << 16 |
393 (u32)cmd[2] << 24;
394
395 *num = (u32)cmd[8] | (u32)cmd[7] << 8;
3de9f944
FT		 396 break;
397 case WRITE_6:
398 case READ_6:
d5cdc989
FT		 399 *lba = (u32)cmd[3] | (u32)cmd[2] << 8 |
400 (u32)(cmd[1] & 0x1f) << 16;
3de9f944
FT		 401 *num = (0 == cmd[4]) ? 256 : cmd[4];
402 break;
403 default:
404 break;
405 }
406}
1da177e4 407
1da177e4
LT		 408static int scsi_debug_ioctl(struct scsi_device *dev, int cmd, void __user *arg)
409{
410 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) {
411 printk(KERN_INFO "scsi_debug: ioctl: cmd=0x%x\n", cmd);
412 }
413 return -EINVAL;
414 /* return -ENOTTY; // correct return but upsets fdisk */
415}
416
c65b1445
DG		 417static int check_readiness(struct scsi_cmnd * SCpnt, int reset_only,
418 struct sdebug_dev_info * devip)
1da177e4
LT		 419{
420 if (devip->reset) {
421 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
422 printk(KERN_INFO "scsi_debug: Reporting Unit "
423 "attention: power on reset\n");
424 devip->reset = 0;
425 mk_sense_buffer(devip, UNIT_ATTENTION, POWERON_RESET, 0);
426 return check_condition_result;
427 }
c65b1445
DG		 428 if ((0 == reset_only) && devip->stopped) {
429 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
430 printk(KERN_INFO "scsi_debug: Reporting Not "
431 "ready: initializing command required\n");
432 mk_sense_buffer(devip, NOT_READY, LOGICAL_UNIT_NOT_READY,
433 0x2);
434 return check_condition_result;
435 }
1da177e4
LT		 436 return 0;
437}
438
439/* Returns 0 if ok else (DID_ERROR << 16). Sets scp->resid . */
21a61829 440static int fill_from_dev_buffer(struct scsi_cmnd *scp, unsigned char *arr,
1da177e4
LT		 441 int arr_len)
442{
21a61829 443 int act_len;
072d0bb3 444 struct scsi_data_buffer *sdb = scsi_in(scp);
1da177e4 445
072d0bb3 446 if (!sdb->length)
1da177e4 447 return 0;
072d0bb3 448 if (!(scsi_bidi_cmnd(scp) || scp->sc_data_direction == DMA_FROM_DEVICE))
1da177e4 449 return (DID_ERROR << 16);
21a61829
FT		 450
451 act_len = sg_copy_from_buffer(sdb->table.sgl, sdb->table.nents,
452 arr, arr_len);
a4517511 453 sdb->resid = scsi_bufflen(scp) - act_len;
21a61829 454
1da177e4
LT		 455 return 0;
456}
457
458/* Returns number of bytes fetched into 'arr' or -1 if error. */
21a61829
FT		 459static int fetch_to_dev_buffer(struct scsi_cmnd *scp, unsigned char *arr,
460 int arr_len)
1da177e4 461{
21a61829 462 if (!scsi_bufflen(scp))
1da177e4 463 return 0;
072d0bb3 464 if (!(scsi_bidi_cmnd(scp) || scp->sc_data_direction == DMA_TO_DEVICE))
1da177e4 465 return -1;
21a61829
FT		 466
467 return scsi_sg_copy_to_buffer(scp, arr, arr_len);
1da177e4
LT		 468}
469
470
471static const char * inq_vendor_id = "Linux ";
472static const char * inq_product_id = "scsi_debug ";
473static const char * inq_product_rev = "0004";
474
5a09e398
HR		 475static int inquiry_evpd_83(unsigned char * arr, int port_group_id,
476 int target_dev_id, int dev_id_num,
477 const char * dev_id_str,
c65b1445 478 int dev_id_str_len)
1da177e4 479{
c65b1445
DG		 480 int num, port_a;
481 char b[32];
1da177e4 482
c65b1445 483 port_a = target_dev_id + 1;
1da177e4
LT		 484 /* T10 vendor identifier field format (faked) */
485 arr[0] = 0x2; /* ASCII */
486 arr[1] = 0x1;
487 arr[2] = 0x0;
488 memcpy(&arr[4], inq_vendor_id, 8);
489 memcpy(&arr[12], inq_product_id, 16);
490 memcpy(&arr[28], dev_id_str, dev_id_str_len);
491 num = 8 + 16 + dev_id_str_len;
492 arr[3] = num;
493 num += 4;
c65b1445
DG		 494 if (dev_id_num >= 0) {
495 /* NAA-5, Logical unit identifier (binary) */
496 arr[num++] = 0x1; /* binary (not necessarily sas) */
497 arr[num++] = 0x3; /* PIV=0, lu, naa */
498 arr[num++] = 0x0;
499 arr[num++] = 0x8;
500 arr[num++] = 0x53; /* naa-5 ieee company id=0x333333 (fake) */
501 arr[num++] = 0x33;
502 arr[num++] = 0x33;
503 arr[num++] = 0x30;
504 arr[num++] = (dev_id_num >> 24);
505 arr[num++] = (dev_id_num >> 16) & 0xff;
506 arr[num++] = (dev_id_num >> 8) & 0xff;
507 arr[num++] = dev_id_num & 0xff;
508 /* Target relative port number */
509 arr[num++] = 0x61; /* proto=sas, binary */
510 arr[num++] = 0x94; /* PIV=1, target port, rel port */
511 arr[num++] = 0x0; /* reserved */
512 arr[num++] = 0x4; /* length */
513 arr[num++] = 0x0; /* reserved */
514 arr[num++] = 0x0; /* reserved */
515 arr[num++] = 0x0;
516 arr[num++] = 0x1; /* relative port A */
517 }
518 /* NAA-5, Target port identifier */
519 arr[num++] = 0x61; /* proto=sas, binary */
520 arr[num++] = 0x93; /* piv=1, target port, naa */
521 arr[num++] = 0x0;
522 arr[num++] = 0x8;
523 arr[num++] = 0x52; /* naa-5, company id=0x222222 (fake) */
524 arr[num++] = 0x22;
525 arr[num++] = 0x22;
526 arr[num++] = 0x20;
527 arr[num++] = (port_a >> 24);
528 arr[num++] = (port_a >> 16) & 0xff;
529 arr[num++] = (port_a >> 8) & 0xff;
530 arr[num++] = port_a & 0xff;
5a09e398
HR		 531 /* NAA-5, Target port group identifier */
532 arr[num++] = 0x61; /* proto=sas, binary */
533 arr[num++] = 0x95; /* piv=1, target port group id */
534 arr[num++] = 0x0;
535 arr[num++] = 0x4;
536 arr[num++] = 0;
537 arr[num++] = 0;
538 arr[num++] = (port_group_id >> 8) & 0xff;
539 arr[num++] = port_group_id & 0xff;
c65b1445
DG		 540 /* NAA-5, Target device identifier */
541 arr[num++] = 0x61; /* proto=sas, binary */
542 arr[num++] = 0xa3; /* piv=1, target device, naa */
543 arr[num++] = 0x0;
544 arr[num++] = 0x8;
545 arr[num++] = 0x52; /* naa-5, company id=0x222222 (fake) */
546 arr[num++] = 0x22;
547 arr[num++] = 0x22;
548 arr[num++] = 0x20;
549 arr[num++] = (target_dev_id >> 24);
550 arr[num++] = (target_dev_id >> 16) & 0xff;
551 arr[num++] = (target_dev_id >> 8) & 0xff;
552 arr[num++] = target_dev_id & 0xff;
553 /* SCSI name string: Target device identifier */
554 arr[num++] = 0x63; /* proto=sas, UTF-8 */
555 arr[num++] = 0xa8; /* piv=1, target device, SCSI name string */
556 arr[num++] = 0x0;
557 arr[num++] = 24;
558 memcpy(arr + num, "naa.52222220", 12);
559 num += 12;
560 snprintf(b, sizeof(b), "%08X", target_dev_id);
561 memcpy(arr + num, b, 8);
562 num += 8;
563 memset(arr + num, 0, 4);
564 num += 4;
565 return num;
566}
567
568
569static unsigned char vpd84_data[] = {
570/* from 4th byte */ 0x22,0x22,0x22,0x0,0xbb,0x0,
571 0x22,0x22,0x22,0x0,0xbb,0x1,
572 0x22,0x22,0x22,0x0,0xbb,0x2,
573};
574
575static int inquiry_evpd_84(unsigned char * arr)
576{
577 memcpy(arr, vpd84_data, sizeof(vpd84_data));
578 return sizeof(vpd84_data);
579}
580
581static int inquiry_evpd_85(unsigned char * arr)
582{
583 int num = 0;
584 const char * na1 = "https://www.kernel.org/config";
585 const char * na2 = "http://www.kernel.org/log";
586 int plen, olen;
587
588 arr[num++] = 0x1; /* lu, storage config */
589 arr[num++] = 0x0; /* reserved */
590 arr[num++] = 0x0;
591 olen = strlen(na1);
592 plen = olen + 1;
593 if (plen % 4)
594 plen = ((plen / 4) + 1) * 4;
595 arr[num++] = plen; /* length, null termianted, padded */
596 memcpy(arr + num, na1, olen);
597 memset(arr + num + olen, 0, plen - olen);
598 num += plen;
599
600 arr[num++] = 0x4; /* lu, logging */
601 arr[num++] = 0x0; /* reserved */
602 arr[num++] = 0x0;
603 olen = strlen(na2);
604 plen = olen + 1;
605 if (plen % 4)
606 plen = ((plen / 4) + 1) * 4;
607 arr[num++] = plen; /* length, null terminated, padded */
608 memcpy(arr + num, na2, olen);
609 memset(arr + num + olen, 0, plen - olen);
610 num += plen;
611
612 return num;
613}
614
615/* SCSI ports VPD page */
616static int inquiry_evpd_88(unsigned char * arr, int target_dev_id)
617{
618 int num = 0;
619 int port_a, port_b;
620
621 port_a = target_dev_id + 1;
622 port_b = port_a + 1;
623 arr[num++] = 0x0; /* reserved */
624 arr[num++] = 0x0; /* reserved */
625 arr[num++] = 0x0;
626 arr[num++] = 0x1; /* relative port 1 (primary) */
627 memset(arr + num, 0, 6);
628 num += 6;
629 arr[num++] = 0x0;
630 arr[num++] = 12; /* length tp descriptor */
631 /* naa-5 target port identifier (A) */
632 arr[num++] = 0x61; /* proto=sas, binary */
633 arr[num++] = 0x93; /* PIV=1, target port, NAA */
634 arr[num++] = 0x0; /* reserved */
635 arr[num++] = 0x8; /* length */
636 arr[num++] = 0x52; /* NAA-5, company_id=0x222222 (fake) */
637 arr[num++] = 0x22;
638 arr[num++] = 0x22;
639 arr[num++] = 0x20;
640 arr[num++] = (port_a >> 24);
641 arr[num++] = (port_a >> 16) & 0xff;
642 arr[num++] = (port_a >> 8) & 0xff;
643 arr[num++] = port_a & 0xff;
644
645 arr[num++] = 0x0; /* reserved */
646 arr[num++] = 0x0; /* reserved */
647 arr[num++] = 0x0;
648 arr[num++] = 0x2; /* relative port 2 (secondary) */
649 memset(arr + num, 0, 6);
650 num += 6;
651 arr[num++] = 0x0;
652 arr[num++] = 12; /* length tp descriptor */
653 /* naa-5 target port identifier (B) */
654 arr[num++] = 0x61; /* proto=sas, binary */
655 arr[num++] = 0x93; /* PIV=1, target port, NAA */
656 arr[num++] = 0x0; /* reserved */
657 arr[num++] = 0x8; /* length */
658 arr[num++] = 0x52; /* NAA-5, company_id=0x222222 (fake) */
659 arr[num++] = 0x22;
660 arr[num++] = 0x22;
661 arr[num++] = 0x20;
662 arr[num++] = (port_b >> 24);
663 arr[num++] = (port_b >> 16) & 0xff;
664 arr[num++] = (port_b >> 8) & 0xff;
665 arr[num++] = port_b & 0xff;
666
667 return num;
668}
669
670
671static unsigned char vpd89_data[] = {
672/* from 4th byte */ 0,0,0,0,
673'l','i','n','u','x',' ',' ',' ',
674'S','A','T',' ','s','c','s','i','_','d','e','b','u','g',' ',' ',
675'1','2','3','4',
6760x34,0,0,0,1,0,0,0,0,0,0,0,1,0,0,0,0,0,0,0,
6770xec,0,0,0,
6780x5a,0xc,0xff,0x3f,0x37,0xc8,0x10,0,0,0,0,0,0x3f,0,0,0,
6790,0,0,0,0x58,0x58,0x58,0x58,0x58,0x58,0x58,0x58,0x20,0x20,0x20,0x20,
6800x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0,0,0,0x40,0x4,0,0x2e,0x33,
6810x38,0x31,0x20,0x20,0x20,0x20,0x54,0x53,0x38,0x33,0x30,0x30,0x33,0x31,
6820x53,0x41,
6830x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
6840x20,0x20,
6850x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,
6860x10,0x80,
6870,0,0,0x2f,0,0,0,0x2,0,0x2,0x7,0,0xff,0xff,0x1,0,
6880x3f,0,0xc1,0xff,0x3e,0,0x10,0x1,0xb0,0xf8,0x50,0x9,0,0,0x7,0,
6890x3,0,0x78,0,0x78,0,0xf0,0,0x78,0,0,0,0,0,0,0,
6900,0,0,0,0,0,0,0,0x2,0,0,0,0,0,0,0,
6910x7e,0,0x1b,0,0x6b,0x34,0x1,0x7d,0x3,0x40,0x69,0x34,0x1,0x3c,0x3,0x40,
6920x7f,0x40,0,0,0,0,0xfe,0xfe,0,0,0,0,0,0xfe,0,0,
6930,0,0,0,0,0,0,0,0xb0,0xf8,0x50,0x9,0,0,0,0,
6940,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
6950,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
6960,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
6970x1,0,0xb0,0xf8,0x50,0x9,0xb0,0xf8,0x50,0x9,0x20,0x20,0x2,0,0xb6,0x42,
6980,0x80,0x8a,0,0x6,0x3c,0xa,0x3c,0xff,0xff,0xc6,0x7,0,0x1,0,0x8,
6990xf0,0xf,0,0x10,0x2,0,0x30,0,0,0,0,0,0,0,0x6,0xfe,
7000,0,0x2,0,0x50,0,0x8a,0,0x4f,0x95,0,0,0x21,0,0xb,0,
7010,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7020,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7030,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7040,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7050,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7060,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7070,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7080,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7090,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7100,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7110,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
7120,0,0,0,0,0,0,0,0,0,0,0,0,0,0xa5,0x51,
713};
714
715static int inquiry_evpd_89(unsigned char * arr)
716{
717 memcpy(arr, vpd89_data, sizeof(vpd89_data));
718 return sizeof(vpd89_data);
719}
720
721
1e49f785 722/* Block limits VPD page (SBC-3) */
c65b1445 723static unsigned char vpdb0_data[] = {
1e49f785
DG		 724 /* from 4th byte */ 0,0,0,4, 0,0,0x4,0, 0,0,0,64,
725 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
726 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
727 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,
c65b1445
DG		 728};
729
730static int inquiry_evpd_b0(unsigned char * arr)
731{
ea61fca5
MP		 732 unsigned int gran;
733
c65b1445 734 memcpy(arr, vpdb0_data, sizeof(vpdb0_data));
e308b3d1
MP		 735
736 /* Optimal transfer length granularity */
ea61fca5
MP		 737 gran = 1 << scsi_debug_physblk_exp;
738 arr[2] = (gran >> 8) & 0xff;
739 arr[3] = gran & 0xff;
e308b3d1
MP		 740
741 /* Maximum Transfer Length */
c65b1445
DG		 742 if (sdebug_store_sectors > 0x400) {
743 arr[4] = (sdebug_store_sectors >> 24) & 0xff;
744 arr[5] = (sdebug_store_sectors >> 16) & 0xff;
745 arr[6] = (sdebug_store_sectors >> 8) & 0xff;
746 arr[7] = sdebug_store_sectors & 0xff;
747 }
44d92694 748
e308b3d1
MP		 749 /* Optimal Transfer Length */
750 put_unaligned_be32(scsi_debug_opt_blks, &arr[8]);
751
5b94e232 752 if (scsi_debug_lbpu) {
e308b3d1 753 /* Maximum Unmap LBA Count */
6014759c 754 put_unaligned_be32(scsi_debug_unmap_max_blocks, &arr[16]);
e308b3d1
MP		 755
756 /* Maximum Unmap Block Descriptor Count */
44d92694
MP		 757 put_unaligned_be32(scsi_debug_unmap_max_desc, &arr[20]);
758 }
759
e308b3d1 760 /* Unmap Granularity Alignment */
44d92694
MP		 761 if (scsi_debug_unmap_alignment) {
762 put_unaligned_be32(scsi_debug_unmap_alignment, &arr[28]);
763 arr[28] |= 0x80; /* UGAVALID */
764 }
765
e308b3d1 766 /* Optimal Unmap Granularity */
6014759c
MP		 767 put_unaligned_be32(scsi_debug_unmap_granularity, &arr[24]);
768
5b94e232
MP		 769 /* Maximum WRITE SAME Length */
770 put_unaligned_be64(scsi_debug_write_same_length, &arr[32]);
771
772 return 0x3c; /* Mandatory page length for Logical Block Provisioning */
44d92694 773
c65b1445 774 return sizeof(vpdb0_data);
1da177e4
LT		 775}
776
1e49f785 777/* Block device characteristics VPD page (SBC-3) */
eac6e8e4
MW		 778static int inquiry_evpd_b1(unsigned char *arr)
779{
780 memset(arr, 0, 0x3c);
781 arr[0] = 0;
1e49f785
DG		 782 arr[1] = 1; /* non rotating medium (e.g. solid state) */
783 arr[2] = 0;
784 arr[3] = 5; /* less than 1.8" */
eac6e8e4
MW		 785
786 return 0x3c;
787}
1da177e4 788
be1dd78d 789/* Logical block provisioning VPD page (SBC-3) */
6014759c
MP		 790static int inquiry_evpd_b2(unsigned char *arr)
791{
3f0bc3b3 792 memset(arr, 0, 0x4);
6014759c
MP		 793 arr[0] = 0; /* threshold exponent */
794
5b94e232 795 if (scsi_debug_lbpu)
6014759c
MP		 796 arr[1] = 1 << 7;
797
5b94e232 798 if (scsi_debug_lbpws)
6014759c
MP		 799 arr[1] |= 1 << 6;
800
5b94e232
MP		 801 if (scsi_debug_lbpws10)
802 arr[1] |= 1 << 5;
803
be1dd78d
ES		 804 if (scsi_debug_lbprz)
805 arr[1] |= 1 << 2;
806
3f0bc3b3 807 return 0x4;
6014759c
MP		 808}
809
1da177e4 810#define SDEBUG_LONG_INQ_SZ 96
c65b1445 811#define SDEBUG_MAX_INQ_ARR_SZ 584
1da177e4
LT		 812
813static int resp_inquiry(struct scsi_cmnd * scp, int target,
814 struct sdebug_dev_info * devip)
815{
816 unsigned char pq_pdt;
5a09e398 817 unsigned char * arr;
1da177e4 818 unsigned char *cmd = (unsigned char *)scp->cmnd;
5a09e398 819 int alloc_len, n, ret;
1da177e4
LT		 820
821 alloc_len = (cmd[3] << 8) + cmd[4];
6f3cbf55
DG		 822 arr = kzalloc(SDEBUG_MAX_INQ_ARR_SZ, GFP_ATOMIC);
823 if (! arr)
824 return DID_REQUEUE << 16;
c65b1445
DG		 825 if (devip->wlun)
826 pq_pdt = 0x1e; /* present, wlun */
827 else if (scsi_debug_no_lun_0 && (0 == devip->lun))
828 pq_pdt = 0x7f; /* not present, no device type */
829 else
830 pq_pdt = (scsi_debug_ptype & 0x1f);
1da177e4
LT		 831 arr[0] = pq_pdt;
832 if (0x2 & cmd[1]) { /* CMDDT bit set */
833 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
834 0);
5a09e398 835 kfree(arr);
1da177e4
LT		 836 return check_condition_result;
837 } else if (0x1 & cmd[1]) { /* EVPD bit set */
5a09e398 838 int lu_id_num, port_group_id, target_dev_id, len;
c65b1445
DG		 839 char lu_id_str[6];
840 int host_no = devip->sdbg_host->shost->host_no;
1da177e4 841
5a09e398
HR		 842 port_group_id = (((host_no + 1) & 0x7f) << 8) +
843 (devip->channel & 0x7f);
23183910
DG		 844 if (0 == scsi_debug_vpd_use_hostno)
845 host_no = 0;
c65b1445
DG		 846 lu_id_num = devip->wlun ? -1 : (((host_no + 1) * 2000) +
847 (devip->target * 1000) + devip->lun);
848 target_dev_id = ((host_no + 1) * 2000) +
849 (devip->target * 1000) - 3;
850 len = scnprintf(lu_id_str, 6, "%d", lu_id_num);
1da177e4 851 if (0 == cmd[2]) { /* supported vital product data pages */
c65b1445
DG		 852 arr[1] = cmd[2]; /*sanity */
853 n = 4;
854 arr[n++] = 0x0; /* this page */
855 arr[n++] = 0x80; /* unit serial number */
856 arr[n++] = 0x83; /* device identification */
857 arr[n++] = 0x84; /* software interface ident. */
858 arr[n++] = 0x85; /* management network addresses */
859 arr[n++] = 0x86; /* extended inquiry */
860 arr[n++] = 0x87; /* mode page policy */
861 arr[n++] = 0x88; /* SCSI ports */
862 arr[n++] = 0x89; /* ATA information */
863 arr[n++] = 0xb0; /* Block limits (SBC) */
eac6e8e4 864 arr[n++] = 0xb1; /* Block characteristics (SBC) */
5b94e232
MP		 865 if (scsi_debug_lbp()) /* Logical Block Prov. (SBC) */
866 arr[n++] = 0xb2;
c65b1445 867 arr[3] = n - 4; /* number of supported VPD pages */
1da177e4 868 } else if (0x80 == cmd[2]) { /* unit serial number */
c65b1445 869 arr[1] = cmd[2]; /*sanity */
1da177e4 870 arr[3] = len;
c65b1445 871 memcpy(&arr[4], lu_id_str, len);
1da177e4 872 } else if (0x83 == cmd[2]) { /* device identification */
c65b1445 873 arr[1] = cmd[2]; /*sanity */
5a09e398
HR		 874 arr[3] = inquiry_evpd_83(&arr[4], port_group_id,
875 target_dev_id, lu_id_num,
876 lu_id_str, len);
c65b1445
DG		 877 } else if (0x84 == cmd[2]) { /* Software interface ident. */
878 arr[1] = cmd[2]; /*sanity */
879 arr[3] = inquiry_evpd_84(&arr[4]);
880 } else if (0x85 == cmd[2]) { /* Management network addresses */
881 arr[1] = cmd[2]; /*sanity */
882 arr[3] = inquiry_evpd_85(&arr[4]);
883 } else if (0x86 == cmd[2]) { /* extended inquiry */
884 arr[1] = cmd[2]; /*sanity */
885 arr[3] = 0x3c; /* number of following entries */
c6a44287
MP		 886 if (scsi_debug_dif == SD_DIF_TYPE3_PROTECTION)
887 arr[4] = 0x4; /* SPT: GRD_CHK:1 */
888 else if (scsi_debug_dif)
889 arr[4] = 0x5; /* SPT: GRD_CHK:1, REF_CHK:1 */
890 else
891 arr[4] = 0x0; /* no protection stuff */
c65b1445
DG		 892 arr[5] = 0x7; /* head of q, ordered + simple q's */
893 } else if (0x87 == cmd[2]) { /* mode page policy */
894 arr[1] = cmd[2]; /*sanity */
895 arr[3] = 0x8; /* number of following entries */
896 arr[4] = 0x2; /* disconnect-reconnect mp */
897 arr[6] = 0x80; /* mlus, shared */
898 arr[8] = 0x18; /* protocol specific lu */
899 arr[10] = 0x82; /* mlus, per initiator port */
900 } else if (0x88 == cmd[2]) { /* SCSI Ports */
901 arr[1] = cmd[2]; /*sanity */
902 arr[3] = inquiry_evpd_88(&arr[4], target_dev_id);
903 } else if (0x89 == cmd[2]) { /* ATA information */
904 arr[1] = cmd[2]; /*sanity */
905 n = inquiry_evpd_89(&arr[4]);
906 arr[2] = (n >> 8);
907 arr[3] = (n & 0xff);
908 } else if (0xb0 == cmd[2]) { /* Block limits (SBC) */
909 arr[1] = cmd[2]; /*sanity */
910 arr[3] = inquiry_evpd_b0(&arr[4]);
eac6e8e4
MW		 911 } else if (0xb1 == cmd[2]) { /* Block characteristics (SBC) */
912 arr[1] = cmd[2]; /*sanity */
913 arr[3] = inquiry_evpd_b1(&arr[4]);
5b94e232 914 } else if (0xb2 == cmd[2]) { /* Logical Block Prov. (SBC) */
6014759c
MP		 915 arr[1] = cmd[2]; /*sanity */
916 arr[3] = inquiry_evpd_b2(&arr[4]);
1da177e4
LT		 917 } else {
918 /* Illegal request, invalid field in cdb */
919 mk_sense_buffer(devip, ILLEGAL_REQUEST,
920 INVALID_FIELD_IN_CDB, 0);
5a09e398 921 kfree(arr);
1da177e4
LT		 922 return check_condition_result;
923 }
c65b1445 924 len = min(((arr[2] << 8) + arr[3]) + 4, alloc_len);
5a09e398 925 ret = fill_from_dev_buffer(scp, arr,
c65b1445 926 min(len, SDEBUG_MAX_INQ_ARR_SZ));
5a09e398
HR		 927 kfree(arr);
928 return ret;
1da177e4
LT		 929 }
930 /* drops through here for a standard inquiry */
d986788b 931 arr[1] = scsi_debug_removable ? 0x80 : 0; /* Removable disk */
1da177e4
LT		 932 arr[2] = scsi_debug_scsi_level;
933 arr[3] = 2; /* response_data_format==2 */
934 arr[4] = SDEBUG_LONG_INQ_SZ - 5;
c6a44287 935 arr[5] = scsi_debug_dif ? 1 : 0; /* PROTECT bit */
5a09e398
HR		 936 if (0 == scsi_debug_vpd_use_hostno)
937 arr[5] = 0x10; /* claim: implicit TGPS */
c65b1445 938 arr[6] = 0x10; /* claim: MultiP */
1da177e4 939 /* arr[6] |= 0x40; ... claim: EncServ (enclosure services) */
c65b1445 940 arr[7] = 0xa; /* claim: LINKED + CMDQUE */
1da177e4
LT		 941 memcpy(&arr[8], inq_vendor_id, 8);
942 memcpy(&arr[16], inq_product_id, 16);
943 memcpy(&arr[32], inq_product_rev, 4);
944 /* version descriptors (2 bytes each) follow */
c65b1445
DG		 945 arr[58] = 0x0; arr[59] = 0x77; /* SAM-3 ANSI */
946 arr[60] = 0x3; arr[61] = 0x14; /* SPC-3 ANSI */
947 n = 62;
1da177e4 948 if (scsi_debug_ptype == 0) {
c65b1445 949 arr[n++] = 0x3; arr[n++] = 0x3d; /* SBC-2 ANSI */
1da177e4 950 } else if (scsi_debug_ptype == 1) {
c65b1445 951 arr[n++] = 0x3; arr[n++] = 0x60; /* SSC-2 no version */
1da177e4 952 }
c65b1445 953 arr[n++] = 0xc; arr[n++] = 0xf; /* SAS-1.1 rev 10 */
5a09e398 954 ret = fill_from_dev_buffer(scp, arr,
1da177e4 955 min(alloc_len, SDEBUG_LONG_INQ_SZ));
5a09e398
HR		 956 kfree(arr);
957 return ret;
1da177e4
LT		 958}
959
960static int resp_requests(struct scsi_cmnd * scp,
961 struct sdebug_dev_info * devip)
962{
963 unsigned char * sbuff;
964 unsigned char *cmd = (unsigned char *)scp->cmnd;
965 unsigned char arr[SDEBUG_SENSE_LEN];
c65b1445 966 int want_dsense;
1da177e4
LT		 967 int len = 18;
968
c65b1445 969 memset(arr, 0, sizeof(arr));
1da177e4 970 if (devip->reset == 1)
c65b1445
DG		 971 mk_sense_buffer(devip, 0, NO_ADDITIONAL_SENSE, 0);
972 want_dsense = !!(cmd[1] & 1) || scsi_debug_dsense;
1da177e4 973 sbuff = devip->sense_buff;
c65b1445
DG		 974 if ((iec_m_pg[2] & 0x4) && (6 == (iec_m_pg[3] & 0xf))) {
975 if (want_dsense) {
976 arr[0] = 0x72;
977 arr[1] = 0x0; /* NO_SENSE in sense_key */
978 arr[2] = THRESHOLD_EXCEEDED;
979 arr[3] = 0xff; /* TEST set and MRIE==6 */
980 } else {
981 arr[0] = 0x70;
982 arr[2] = 0x0; /* NO_SENSE in sense_key */
983 arr[7] = 0xa; /* 18 byte sense buffer */
984 arr[12] = THRESHOLD_EXCEEDED;
985 arr[13] = 0xff; /* TEST set and MRIE==6 */
986 }
c65b1445 987 } else {
1da177e4 988 memcpy(arr, sbuff, SDEBUG_SENSE_LEN);
c65b1445
DG		 989 if ((cmd[1] & 1) && (! scsi_debug_dsense)) {
990 /* DESC bit set and sense_buff in fixed format */
991 memset(arr, 0, sizeof(arr));
992 arr[0] = 0x72;
993 arr[1] = sbuff[2]; /* sense key */
994 arr[2] = sbuff[12]; /* asc */
995 arr[3] = sbuff[13]; /* ascq */
996 len = 8;
997 }
998 }
999 mk_sense_buffer(devip, 0, NO_ADDITIONAL_SENSE, 0);
1da177e4
LT		 1000 return fill_from_dev_buffer(scp, arr, len);
1001}
1002
c65b1445
DG		 1003static int resp_start_stop(struct scsi_cmnd * scp,
1004 struct sdebug_dev_info * devip)
1005{
1006 unsigned char *cmd = (unsigned char *)scp->cmnd;
1007 int power_cond, errsts, start;
1008
1009 if ((errsts = check_readiness(scp, 1, devip)))
1010 return errsts;
1011 power_cond = (cmd[4] & 0xf0) >> 4;
1012 if (power_cond) {
1013 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
1014 0);
1015 return check_condition_result;
1016 }
1017 start = cmd[4] & 1;
1018 if (start == devip->stopped)
1019 devip->stopped = !start;
1020 return 0;
1021}
1022
28898873
FT		 1023static sector_t get_sdebug_capacity(void)
1024{
1025 if (scsi_debug_virtual_gb > 0)
5447ed6c
DG		 1026 return (sector_t)scsi_debug_virtual_gb *
1027 (1073741824 / scsi_debug_sector_size);
28898873
FT		 1028 else
1029 return sdebug_store_sectors;
1030}
1031
1da177e4
LT		 1032#define SDEBUG_READCAP_ARR_SZ 8
1033static int resp_readcap(struct scsi_cmnd * scp,
1034 struct sdebug_dev_info * devip)
1035{
1036 unsigned char arr[SDEBUG_READCAP_ARR_SZ];
c65b1445 1037 unsigned int capac;
1da177e4
LT		 1038 int errsts;
1039
c65b1445 1040 if ((errsts = check_readiness(scp, 1, devip)))
1da177e4 1041 return errsts;
c65b1445 1042 /* following just in case virtual_gb changed */
28898873 1043 sdebug_capacity = get_sdebug_capacity();
1da177e4 1044 memset(arr, 0, SDEBUG_READCAP_ARR_SZ);
c65b1445
DG		 1045 if (sdebug_capacity < 0xffffffff) {
1046 capac = (unsigned int)sdebug_capacity - 1;
1047 arr[0] = (capac >> 24);
1048 arr[1] = (capac >> 16) & 0xff;
1049 arr[2] = (capac >> 8) & 0xff;
1050 arr[3] = capac & 0xff;
1051 } else {
1052 arr[0] = 0xff;
1053 arr[1] = 0xff;
1054 arr[2] = 0xff;
1055 arr[3] = 0xff;
1056 }
597136ab
MP		 1057 arr[6] = (scsi_debug_sector_size >> 8) & 0xff;
1058 arr[7] = scsi_debug_sector_size & 0xff;
1da177e4
LT		 1059 return fill_from_dev_buffer(scp, arr, SDEBUG_READCAP_ARR_SZ);
1060}
1061
c65b1445
DG		 1062#define SDEBUG_READCAP16_ARR_SZ 32
1063static int resp_readcap16(struct scsi_cmnd * scp,
1064 struct sdebug_dev_info * devip)
1065{
1066 unsigned char *cmd = (unsigned char *)scp->cmnd;
1067 unsigned char arr[SDEBUG_READCAP16_ARR_SZ];
1068 unsigned long long capac;
1069 int errsts, k, alloc_len;
1070
1071 if ((errsts = check_readiness(scp, 1, devip)))
1072 return errsts;
1073 alloc_len = ((cmd[10] << 24) + (cmd[11] << 16) + (cmd[12] << 8)
1074 + cmd[13]);
1075 /* following just in case virtual_gb changed */
28898873 1076 sdebug_capacity = get_sdebug_capacity();
c65b1445
DG		 1077 memset(arr, 0, SDEBUG_READCAP16_ARR_SZ);
1078 capac = sdebug_capacity - 1;
1079 for (k = 0; k < 8; ++k, capac >>= 8)
1080 arr[7 - k] = capac & 0xff;
597136ab
MP		 1081 arr[8] = (scsi_debug_sector_size >> 24) & 0xff;
1082 arr[9] = (scsi_debug_sector_size >> 16) & 0xff;
1083 arr[10] = (scsi_debug_sector_size >> 8) & 0xff;
1084 arr[11] = scsi_debug_sector_size & 0xff;
ea61fca5
MP		 1085 arr[13] = scsi_debug_physblk_exp & 0xf;
1086 arr[14] = (scsi_debug_lowest_aligned >> 8) & 0x3f;
44d92694 1087
be1dd78d 1088 if (scsi_debug_lbp()) {
5b94e232 1089 arr[14] |= 0x80; /* LBPME */
be1dd78d
ES		 1090 if (scsi_debug_lbprz)
1091 arr[14] |= 0x40; /* LBPRZ */
1092 }
44d92694 1093
ea61fca5 1094 arr[15] = scsi_debug_lowest_aligned & 0xff;
c6a44287
MP		 1095
1096 if (scsi_debug_dif) {
1097 arr[12] = (scsi_debug_dif - 1) << 1; /* P_TYPE */
1098 arr[12] |= 1; /* PROT_EN */
1099 }
1100
c65b1445
DG		 1101 return fill_from_dev_buffer(scp, arr,
1102 min(alloc_len, SDEBUG_READCAP16_ARR_SZ));
1103}
1104
5a09e398
HR		 1105#define SDEBUG_MAX_TGTPGS_ARR_SZ 1412
1106
1107static int resp_report_tgtpgs(struct scsi_cmnd * scp,
1108 struct sdebug_dev_info * devip)
1109{
1110 unsigned char *cmd = (unsigned char *)scp->cmnd;
1111 unsigned char * arr;
1112 int host_no = devip->sdbg_host->shost->host_no;
1113 int n, ret, alen, rlen;
1114 int port_group_a, port_group_b, port_a, port_b;
1115
1116 alen = ((cmd[6] << 24) + (cmd[7] << 16) + (cmd[8] << 8)
1117 + cmd[9]);
1118
6f3cbf55
DG		 1119 arr = kzalloc(SDEBUG_MAX_TGTPGS_ARR_SZ, GFP_ATOMIC);
1120 if (! arr)
1121 return DID_REQUEUE << 16;
5a09e398
HR		 1122 /*
1123 * EVPD page 0x88 states we have two ports, one
1124 * real and a fake port with no device connected.
1125 * So we create two port groups with one port each
1126 * and set the group with port B to unavailable.
1127 */
1128 port_a = 0x1; /* relative port A */
1129 port_b = 0x2; /* relative port B */
1130 port_group_a = (((host_no + 1) & 0x7f) << 8) +
1131 (devip->channel & 0x7f);
1132 port_group_b = (((host_no + 1) & 0x7f) << 8) +
1133 (devip->channel & 0x7f) + 0x80;
1134
1135 /*
1136 * The asymmetric access state is cycled according to the host_id.
1137 */
1138 n = 4;
1139 if (0 == scsi_debug_vpd_use_hostno) {
1140 arr[n++] = host_no % 3; /* Asymm access state */
1141 arr[n++] = 0x0F; /* claim: all states are supported */
1142 } else {
1143 arr[n++] = 0x0; /* Active/Optimized path */
1144 arr[n++] = 0x01; /* claim: only support active/optimized paths */
1145 }
1146 arr[n++] = (port_group_a >> 8) & 0xff;
1147 arr[n++] = port_group_a & 0xff;
1148 arr[n++] = 0; /* Reserved */
1149 arr[n++] = 0; /* Status code */
1150 arr[n++] = 0; /* Vendor unique */
1151 arr[n++] = 0x1; /* One port per group */
1152 arr[n++] = 0; /* Reserved */
1153 arr[n++] = 0; /* Reserved */
1154 arr[n++] = (port_a >> 8) & 0xff;
1155 arr[n++] = port_a & 0xff;
1156 arr[n++] = 3; /* Port unavailable */
1157 arr[n++] = 0x08; /* claim: only unavailalbe paths are supported */
1158 arr[n++] = (port_group_b >> 8) & 0xff;
1159 arr[n++] = port_group_b & 0xff;
1160 arr[n++] = 0; /* Reserved */
1161 arr[n++] = 0; /* Status code */
1162 arr[n++] = 0; /* Vendor unique */
1163 arr[n++] = 0x1; /* One port per group */
1164 arr[n++] = 0; /* Reserved */
1165 arr[n++] = 0; /* Reserved */
1166 arr[n++] = (port_b >> 8) & 0xff;
1167 arr[n++] = port_b & 0xff;
1168
1169 rlen = n - 4;
1170 arr[0] = (rlen >> 24) & 0xff;
1171 arr[1] = (rlen >> 16) & 0xff;
1172 arr[2] = (rlen >> 8) & 0xff;
1173 arr[3] = rlen & 0xff;
1174
1175 /*
1176 * Return the smallest value of either
1177 * - The allocated length
1178 * - The constructed command length
1179 * - The maximum array size
1180 */
1181 rlen = min(alen,n);
1182 ret = fill_from_dev_buffer(scp, arr,
1183 min(rlen, SDEBUG_MAX_TGTPGS_ARR_SZ));
1184 kfree(arr);
1185 return ret;
1186}
1187
1da177e4
LT		 1188/* <<Following mode page info copied from ST318451LW>> */
1189
1190static int resp_err_recov_pg(unsigned char * p, int pcontrol, int target)
1191{ /* Read-Write Error Recovery page for mode_sense */
1192 unsigned char err_recov_pg[] = {0x1, 0xa, 0xc0, 11, 240, 0, 0, 0,
1193 5, 0, 0xff, 0xff};
1194
1195 memcpy(p, err_recov_pg, sizeof(err_recov_pg));
1196 if (1 == pcontrol)
1197 memset(p + 2, 0, sizeof(err_recov_pg) - 2);
1198 return sizeof(err_recov_pg);
1199}
1200
1201static int resp_disconnect_pg(unsigned char * p, int pcontrol, int target)
1202{ /* Disconnect-Reconnect page for mode_sense */
1203 unsigned char disconnect_pg[] = {0x2, 0xe, 128, 128, 0, 10, 0, 0,
1204 0, 0, 0, 0, 0, 0, 0, 0};
1205
1206 memcpy(p, disconnect_pg, sizeof(disconnect_pg));
1207 if (1 == pcontrol)
1208 memset(p + 2, 0, sizeof(disconnect_pg) - 2);
1209 return sizeof(disconnect_pg);
1210}
1211
1212static int resp_format_pg(unsigned char * p, int pcontrol, int target)
1213{ /* Format device page for mode_sense */
597136ab
MP		 1214 unsigned char format_pg[] = {0x3, 0x16, 0, 0, 0, 0, 0, 0,
1215 0, 0, 0, 0, 0, 0, 0, 0,
1216 0, 0, 0, 0, 0x40, 0, 0, 0};
1217
1218 memcpy(p, format_pg, sizeof(format_pg));
1219 p[10] = (sdebug_sectors_per >> 8) & 0xff;
1220 p[11] = sdebug_sectors_per & 0xff;
1221 p[12] = (scsi_debug_sector_size >> 8) & 0xff;
1222 p[13] = scsi_debug_sector_size & 0xff;
d986788b 1223 if (scsi_debug_removable)
597136ab
MP		 1224 p[20] |= 0x20; /* should agree with INQUIRY */
1225 if (1 == pcontrol)
1226 memset(p + 2, 0, sizeof(format_pg) - 2);
1227 return sizeof(format_pg);
1da177e4
LT		 1228}
1229
1230static int resp_caching_pg(unsigned char * p, int pcontrol, int target)
1231{ /* Caching page for mode_sense */
1232 unsigned char caching_pg[] = {0x8, 18, 0x14, 0, 0xff, 0xff, 0, 0,
1233 0xff, 0xff, 0xff, 0xff, 0x80, 0x14, 0, 0, 0, 0, 0, 0};
1234
1235 memcpy(p, caching_pg, sizeof(caching_pg));
1236 if (1 == pcontrol)
1237 memset(p + 2, 0, sizeof(caching_pg) - 2);
1238 return sizeof(caching_pg);
1239}
1240
1241static int resp_ctrl_m_pg(unsigned char * p, int pcontrol, int target)
1242{ /* Control mode page for mode_sense */
c65b1445
DG		 1243 unsigned char ch_ctrl_m_pg[] = {/* 0xa, 10, */ 0x6, 0, 0, 0, 0, 0,
1244 0, 0, 0, 0};
1245 unsigned char d_ctrl_m_pg[] = {0xa, 10, 2, 0, 0, 0, 0, 0,
1da177e4
LT		 1246 0, 0, 0x2, 0x4b};
1247
1248 if (scsi_debug_dsense)
1249 ctrl_m_pg[2] |= 0x4;
c65b1445
DG		 1250 else
1251 ctrl_m_pg[2] &= ~0x4;
c6a44287
MP		 1252
1253 if (scsi_debug_ato)
1254 ctrl_m_pg[5] |= 0x80; /* ATO=1 */
1255
1da177e4
LT		 1256 memcpy(p, ctrl_m_pg, sizeof(ctrl_m_pg));
1257 if (1 == pcontrol)
c65b1445
DG		 1258 memcpy(p + 2, ch_ctrl_m_pg, sizeof(ch_ctrl_m_pg));
1259 else if (2 == pcontrol)
1260 memcpy(p, d_ctrl_m_pg, sizeof(d_ctrl_m_pg));
1da177e4
LT		 1261 return sizeof(ctrl_m_pg);
1262}
1263
c65b1445 1264
1da177e4
LT		 1265static int resp_iec_m_pg(unsigned char * p, int pcontrol, int target)
1266{ /* Informational Exceptions control mode page for mode_sense */
c65b1445
DG		 1267 unsigned char ch_iec_m_pg[] = {/* 0x1c, 0xa, */ 0x4, 0xf, 0, 0, 0, 0,
1268 0, 0, 0x0, 0x0};
1269 unsigned char d_iec_m_pg[] = {0x1c, 0xa, 0x08, 0, 0, 0, 0, 0,
1270 0, 0, 0x0, 0x0};
1271
1da177e4
LT		 1272 memcpy(p, iec_m_pg, sizeof(iec_m_pg));
1273 if (1 == pcontrol)
c65b1445
DG		 1274 memcpy(p + 2, ch_iec_m_pg, sizeof(ch_iec_m_pg));
1275 else if (2 == pcontrol)
1276 memcpy(p, d_iec_m_pg, sizeof(d_iec_m_pg));
1da177e4
LT		 1277 return sizeof(iec_m_pg);
1278}
1279
c65b1445
DG		 1280static int resp_sas_sf_m_pg(unsigned char * p, int pcontrol, int target)
1281{ /* SAS SSP mode page - short format for mode_sense */
1282 unsigned char sas_sf_m_pg[] = {0x19, 0x6,
1283 0x6, 0x0, 0x7, 0xd0, 0x0, 0x0};
1284
1285 memcpy(p, sas_sf_m_pg, sizeof(sas_sf_m_pg));
1286 if (1 == pcontrol)
1287 memset(p + 2, 0, sizeof(sas_sf_m_pg) - 2);
1288 return sizeof(sas_sf_m_pg);
1289}
1290
1291
1292static int resp_sas_pcd_m_spg(unsigned char * p, int pcontrol, int target,
1293 int target_dev_id)
1294{ /* SAS phy control and discover mode page for mode_sense */
1295 unsigned char sas_pcd_m_pg[] = {0x59, 0x1, 0, 0x64, 0, 0x6, 0, 2,
1296 0, 0, 0, 0, 0x10, 0x9, 0x8, 0x0,
1297 0x52, 0x22, 0x22, 0x20, 0x0, 0x0, 0x0, 0x0,
1298 0x51, 0x11, 0x11, 0x10, 0x0, 0x0, 0x0, 0x1,
1299 0x2, 0, 0, 0, 0, 0, 0, 0,
1300 0x88, 0x99, 0, 0, 0, 0, 0, 0,
1301 0, 0, 0, 0, 0, 0, 0, 0,
1302 0, 1, 0, 0, 0x10, 0x9, 0x8, 0x0,
1303 0x52, 0x22, 0x22, 0x20, 0x0, 0x0, 0x0, 0x0,
1304 0x51, 0x11, 0x11, 0x10, 0x0, 0x0, 0x0, 0x1,
1305 0x3, 0, 0, 0, 0, 0, 0, 0,
1306 0x88, 0x99, 0, 0, 0, 0, 0, 0,
1307 0, 0, 0, 0, 0, 0, 0, 0,
1308 };
1309 int port_a, port_b;
1310
1311 port_a = target_dev_id + 1;
1312 port_b = port_a + 1;
1313 memcpy(p, sas_pcd_m_pg, sizeof(sas_pcd_m_pg));
1314 p[20] = (port_a >> 24);
1315 p[21] = (port_a >> 16) & 0xff;
1316 p[22] = (port_a >> 8) & 0xff;
1317 p[23] = port_a & 0xff;
1318 p[48 + 20] = (port_b >> 24);
1319 p[48 + 21] = (port_b >> 16) & 0xff;
1320 p[48 + 22] = (port_b >> 8) & 0xff;
1321 p[48 + 23] = port_b & 0xff;
1322 if (1 == pcontrol)
1323 memset(p + 4, 0, sizeof(sas_pcd_m_pg) - 4);
1324 return sizeof(sas_pcd_m_pg);
1325}
1326
1327static int resp_sas_sha_m_spg(unsigned char * p, int pcontrol)
1328{ /* SAS SSP shared protocol specific port mode subpage */
1329 unsigned char sas_sha_m_pg[] = {0x59, 0x2, 0, 0xc, 0, 0x6, 0x10, 0,
1330 0, 0, 0, 0, 0, 0, 0, 0,
1331 };
1332
1333 memcpy(p, sas_sha_m_pg, sizeof(sas_sha_m_pg));
1334 if (1 == pcontrol)
1335 memset(p + 4, 0, sizeof(sas_sha_m_pg) - 4);
1336 return sizeof(sas_sha_m_pg);
1337}
1338
1da177e4
LT		 1339#define SDEBUG_MAX_MSENSE_SZ 256
1340
1341static int resp_mode_sense(struct scsi_cmnd * scp, int target,
1342 struct sdebug_dev_info * devip)
1343{
23183910
DG		 1344 unsigned char dbd, llbaa;
1345 int pcontrol, pcode, subpcode, bd_len;
1da177e4 1346 unsigned char dev_spec;
23183910 1347 int k, alloc_len, msense_6, offset, len, errsts, target_dev_id;
1da177e4
LT		 1348 unsigned char * ap;
1349 unsigned char arr[SDEBUG_MAX_MSENSE_SZ];
1350 unsigned char *cmd = (unsigned char *)scp->cmnd;
1351
c65b1445 1352 if ((errsts = check_readiness(scp, 1, devip)))
1da177e4 1353 return errsts;
23183910 1354 dbd = !!(cmd[1] & 0x8);
1da177e4
LT		 1355 pcontrol = (cmd[2] & 0xc0) >> 6;
1356 pcode = cmd[2] & 0x3f;
1357 subpcode = cmd[3];
1358 msense_6 = (MODE_SENSE == cmd[0]);
23183910
DG		 1359 llbaa = msense_6 ? 0 : !!(cmd[1] & 0x10);
1360 if ((0 == scsi_debug_ptype) && (0 == dbd))
1361 bd_len = llbaa ? 16 : 8;
1362 else
1363 bd_len = 0;
1da177e4
LT		 1364 alloc_len = msense_6 ? cmd[4] : ((cmd[7] << 8) | cmd[8]);
1365 memset(arr, 0, SDEBUG_MAX_MSENSE_SZ);
1366 if (0x3 == pcontrol) { /* Saving values not supported */
1367 mk_sense_buffer(devip, ILLEGAL_REQUEST, SAVING_PARAMS_UNSUP,
1368 0);
1369 return check_condition_result;
1370 }
c65b1445
DG		 1371 target_dev_id = ((devip->sdbg_host->shost->host_no + 1) * 2000) +
1372 (devip->target * 1000) - 3;
23183910
DG		 1373 /* set DPOFUA bit for disks */
1374 if (0 == scsi_debug_ptype)
1375 dev_spec = (DEV_READONLY(target) ? 0x80 : 0x0) | 0x10;
1376 else
1377 dev_spec = 0x0;
1da177e4
LT		 1378 if (msense_6) {
1379 arr[2] = dev_spec;
23183910 1380 arr[3] = bd_len;
1da177e4
LT		 1381 offset = 4;
1382 } else {
1383 arr[3] = dev_spec;
23183910
DG		 1384 if (16 == bd_len)
1385 arr[4] = 0x1; /* set LONGLBA bit */
1386 arr[7] = bd_len; /* assume 255 or less */
1da177e4
LT		 1387 offset = 8;
1388 }
1389 ap = arr + offset;
28898873
FT		 1390 if ((bd_len > 0) && (!sdebug_capacity))
1391 sdebug_capacity = get_sdebug_capacity();
1392
23183910
DG		 1393 if (8 == bd_len) {
1394 if (sdebug_capacity > 0xfffffffe) {
1395 ap[0] = 0xff;
1396 ap[1] = 0xff;
1397 ap[2] = 0xff;
1398 ap[3] = 0xff;
1399 } else {
1400 ap[0] = (sdebug_capacity >> 24) & 0xff;
1401 ap[1] = (sdebug_capacity >> 16) & 0xff;
1402 ap[2] = (sdebug_capacity >> 8) & 0xff;
1403 ap[3] = sdebug_capacity & 0xff;
1404 }
597136ab
MP		 1405 ap[6] = (scsi_debug_sector_size >> 8) & 0xff;
1406 ap[7] = scsi_debug_sector_size & 0xff;
23183910
DG		 1407 offset += bd_len;
1408 ap = arr + offset;
1409 } else if (16 == bd_len) {
1410 unsigned long long capac = sdebug_capacity;
1411
1412 for (k = 0; k < 8; ++k, capac >>= 8)
1413 ap[7 - k] = capac & 0xff;
597136ab
MP		 1414 ap[12] = (scsi_debug_sector_size >> 24) & 0xff;
1415 ap[13] = (scsi_debug_sector_size >> 16) & 0xff;
1416 ap[14] = (scsi_debug_sector_size >> 8) & 0xff;
1417 ap[15] = scsi_debug_sector_size & 0xff;
23183910
DG		 1418 offset += bd_len;
1419 ap = arr + offset;
1420 }
1da177e4 1421
c65b1445
DG		 1422 if ((subpcode > 0x0) && (subpcode < 0xff) && (0x19 != pcode)) {
1423 /* TODO: Control Extension page */
1da177e4
LT		 1424 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
1425 0);
1426 return check_condition_result;
1427 }
1428 switch (pcode) {
1429 case 0x1: /* Read-Write error recovery page, direct access */
1430 len = resp_err_recov_pg(ap, pcontrol, target);
1431 offset += len;
1432 break;
1433 case 0x2: /* Disconnect-Reconnect page, all devices */
1434 len = resp_disconnect_pg(ap, pcontrol, target);
1435 offset += len;
1436 break;
1437 case 0x3: /* Format device page, direct access */
1438 len = resp_format_pg(ap, pcontrol, target);
1439 offset += len;
1440 break;
1441 case 0x8: /* Caching page, direct access */
1442 len = resp_caching_pg(ap, pcontrol, target);
1443 offset += len;
1444 break;
1445 case 0xa: /* Control Mode page, all devices */
1446 len = resp_ctrl_m_pg(ap, pcontrol, target);
1447 offset += len;
1448 break;
c65b1445
DG		 1449 case 0x19: /* if spc==1 then sas phy, control+discover */
1450 if ((subpcode > 0x2) && (subpcode < 0xff)) {
1451 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1452 INVALID_FIELD_IN_CDB, 0);
1453 return check_condition_result;
1454 }
1455 len = 0;
1456 if ((0x0 == subpcode) || (0xff == subpcode))
1457 len += resp_sas_sf_m_pg(ap + len, pcontrol, target);
1458 if ((0x1 == subpcode) || (0xff == subpcode))
1459 len += resp_sas_pcd_m_spg(ap + len, pcontrol, target,
1460 target_dev_id);
1461 if ((0x2 == subpcode) || (0xff == subpcode))
1462 len += resp_sas_sha_m_spg(ap + len, pcontrol);
1463 offset += len;
1464 break;
1da177e4
LT		 1465 case 0x1c: /* Informational Exceptions Mode page, all devices */
1466 len = resp_iec_m_pg(ap, pcontrol, target);
1467 offset += len;
1468 break;
1469 case 0x3f: /* Read all Mode pages */
c65b1445
DG		 1470 if ((0 == subpcode) || (0xff == subpcode)) {
1471 len = resp_err_recov_pg(ap, pcontrol, target);
1472 len += resp_disconnect_pg(ap + len, pcontrol, target);
1473 len += resp_format_pg(ap + len, pcontrol, target);
1474 len += resp_caching_pg(ap + len, pcontrol, target);
1475 len += resp_ctrl_m_pg(ap + len, pcontrol, target);
1476 len += resp_sas_sf_m_pg(ap + len, pcontrol, target);
1477 if (0xff == subpcode) {
1478 len += resp_sas_pcd_m_spg(ap + len, pcontrol,
1479 target, target_dev_id);
1480 len += resp_sas_sha_m_spg(ap + len, pcontrol);
1481 }
1482 len += resp_iec_m_pg(ap + len, pcontrol, target);
1483 } else {
1484 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1485 INVALID_FIELD_IN_CDB, 0);
1486 return check_condition_result;
1487 }
1da177e4
LT		 1488 offset += len;
1489 break;
1490 default:
1491 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
1492 0);
1493 return check_condition_result;
1494 }
1495 if (msense_6)
1496 arr[0] = offset - 1;
1497 else {
1498 arr[0] = ((offset - 2) >> 8) & 0xff;
1499 arr[1] = (offset - 2) & 0xff;
1500 }
1501 return fill_from_dev_buffer(scp, arr, min(alloc_len, offset));
1502}
1503
c65b1445
DG		 1504#define SDEBUG_MAX_MSELECT_SZ 512
1505
1506static int resp_mode_select(struct scsi_cmnd * scp, int mselect6,
1507 struct sdebug_dev_info * devip)
1508{
1509 int pf, sp, ps, md_len, bd_len, off, spf, pg_len;
1510 int param_len, res, errsts, mpage;
1511 unsigned char arr[SDEBUG_MAX_MSELECT_SZ];
1512 unsigned char *cmd = (unsigned char *)scp->cmnd;
1513
1514 if ((errsts = check_readiness(scp, 1, devip)))
1515 return errsts;
1516 memset(arr, 0, sizeof(arr));
1517 pf = cmd[1] & 0x10;
1518 sp = cmd[1] & 0x1;
1519 param_len = mselect6 ? cmd[4] : ((cmd[7] << 8) + cmd[8]);
1520 if ((0 == pf) || sp || (param_len > SDEBUG_MAX_MSELECT_SZ)) {
1521 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1522 INVALID_FIELD_IN_CDB, 0);
1523 return check_condition_result;
1524 }
1525 res = fetch_to_dev_buffer(scp, arr, param_len);
1526 if (-1 == res)
1527 return (DID_ERROR << 16);
1528 else if ((res < param_len) &&
1529 (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts))
1530 printk(KERN_INFO "scsi_debug: mode_select: cdb indicated=%d, "
1531 " IO sent=%d bytes\n", param_len, res);
1532 md_len = mselect6 ? (arr[0] + 1) : ((arr[0] << 8) + arr[1] + 2);
1533 bd_len = mselect6 ? arr[3] : ((arr[6] << 8) + arr[7]);
23183910 1534 if (md_len > 2) {
c65b1445
DG		 1535 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1536 INVALID_FIELD_IN_PARAM_LIST, 0);
1537 return check_condition_result;
1538 }
1539 off = bd_len + (mselect6 ? 4 : 8);
1540 mpage = arr[off] & 0x3f;
1541 ps = !!(arr[off] & 0x80);
1542 if (ps) {
1543 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1544 INVALID_FIELD_IN_PARAM_LIST, 0);
1545 return check_condition_result;
1546 }
1547 spf = !!(arr[off] & 0x40);
1548 pg_len = spf ? ((arr[off + 2] << 8) + arr[off + 3] + 4) :
1549 (arr[off + 1] + 2);
1550 if ((pg_len + off) > param_len) {
1551 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1552 PARAMETER_LIST_LENGTH_ERR, 0);
1553 return check_condition_result;
1554 }
1555 switch (mpage) {
1556 case 0xa: /* Control Mode page */
1557 if (ctrl_m_pg[1] == arr[off + 1]) {
1558 memcpy(ctrl_m_pg + 2, arr + off + 2,
1559 sizeof(ctrl_m_pg) - 2);
1560 scsi_debug_dsense = !!(ctrl_m_pg[2] & 0x4);
1561 return 0;
1562 }
1563 break;
1564 case 0x1c: /* Informational Exceptions Mode page */
1565 if (iec_m_pg[1] == arr[off + 1]) {
1566 memcpy(iec_m_pg + 2, arr + off + 2,
1567 sizeof(iec_m_pg) - 2);
1568 return 0;
1569 }
1570 break;
1571 default:
1572 break;
1573 }
1574 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1575 INVALID_FIELD_IN_PARAM_LIST, 0);
1576 return check_condition_result;
1577}
1578
1579static int resp_temp_l_pg(unsigned char * arr)
1580{
1581 unsigned char temp_l_pg[] = {0x0, 0x0, 0x3, 0x2, 0x0, 38,
1582 0x0, 0x1, 0x3, 0x2, 0x0, 65,
1583 };
1584
1585 memcpy(arr, temp_l_pg, sizeof(temp_l_pg));
1586 return sizeof(temp_l_pg);
1587}
1588
1589static int resp_ie_l_pg(unsigned char * arr)
1590{
1591 unsigned char ie_l_pg[] = {0x0, 0x0, 0x3, 0x3, 0x0, 0x0, 38,
1592 };
1593
1594 memcpy(arr, ie_l_pg, sizeof(ie_l_pg));
1595 if (iec_m_pg[2] & 0x4) { /* TEST bit set */
1596 arr[4] = THRESHOLD_EXCEEDED;
1597 arr[5] = 0xff;
1598 }
1599 return sizeof(ie_l_pg);
1600}
1601
1602#define SDEBUG_MAX_LSENSE_SZ 512
1603
1604static int resp_log_sense(struct scsi_cmnd * scp,
1605 struct sdebug_dev_info * devip)
1606{
23183910 1607 int ppc, sp, pcontrol, pcode, subpcode, alloc_len, errsts, len, n;
c65b1445
DG		 1608 unsigned char arr[SDEBUG_MAX_LSENSE_SZ];
1609 unsigned char *cmd = (unsigned char *)scp->cmnd;
1610
1611 if ((errsts = check_readiness(scp, 1, devip)))
1612 return errsts;
1613 memset(arr, 0, sizeof(arr));
1614 ppc = cmd[1] & 0x2;
1615 sp = cmd[1] & 0x1;
1616 if (ppc || sp) {
1617 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1618 INVALID_FIELD_IN_CDB, 0);
1619 return check_condition_result;
1620 }
1621 pcontrol = (cmd[2] & 0xc0) >> 6;
1622 pcode = cmd[2] & 0x3f;
23183910 1623 subpcode = cmd[3] & 0xff;
c65b1445
DG		 1624 alloc_len = (cmd[7] << 8) + cmd[8];
1625 arr[0] = pcode;
23183910
DG		 1626 if (0 == subpcode) {
1627 switch (pcode) {
1628 case 0x0: /* Supported log pages log page */
1629 n = 4;
1630 arr[n++] = 0x0; /* this page */
1631 arr[n++] = 0xd; /* Temperature */
1632 arr[n++] = 0x2f; /* Informational exceptions */
1633 arr[3] = n - 4;
1634 break;
1635 case 0xd: /* Temperature log page */
1636 arr[3] = resp_temp_l_pg(arr + 4);
1637 break;
1638 case 0x2f: /* Informational exceptions log page */
1639 arr[3] = resp_ie_l_pg(arr + 4);
1640 break;
1641 default:
1642 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1643 INVALID_FIELD_IN_CDB, 0);
1644 return check_condition_result;
1645 }
1646 } else if (0xff == subpcode) {
1647 arr[0] |= 0x40;
1648 arr[1] = subpcode;
1649 switch (pcode) {
1650 case 0x0: /* Supported log pages and subpages log page */
1651 n = 4;
1652 arr[n++] = 0x0;
1653 arr[n++] = 0x0; /* 0,0 page */
1654 arr[n++] = 0x0;
1655 arr[n++] = 0xff; /* this page */
1656 arr[n++] = 0xd;
1657 arr[n++] = 0x0; /* Temperature */
1658 arr[n++] = 0x2f;
1659 arr[n++] = 0x0; /* Informational exceptions */
1660 arr[3] = n - 4;
1661 break;
1662 case 0xd: /* Temperature subpages */
1663 n = 4;
1664 arr[n++] = 0xd;
1665 arr[n++] = 0x0; /* Temperature */
1666 arr[3] = n - 4;
1667 break;
1668 case 0x2f: /* Informational exceptions subpages */
1669 n = 4;
1670 arr[n++] = 0x2f;
1671 arr[n++] = 0x0; /* Informational exceptions */
1672 arr[3] = n - 4;
1673 break;
1674 default:
1675 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1676 INVALID_FIELD_IN_CDB, 0);
1677 return check_condition_result;
1678 }
1679 } else {
c65b1445
DG		 1680 mk_sense_buffer(devip, ILLEGAL_REQUEST,
1681 INVALID_FIELD_IN_CDB, 0);
1682 return check_condition_result;
1683 }
1684 len = min(((arr[2] << 8) + arr[3]) + 4, alloc_len);
1685 return fill_from_dev_buffer(scp, arr,
1686 min(len, SDEBUG_MAX_INQ_ARR_SZ));
1687}
1688
19789100
FT		 1689static int check_device_access_params(struct sdebug_dev_info *devi,
1690 unsigned long long lba, unsigned int num)
1da177e4 1691{
c65b1445 1692 if (lba + num > sdebug_capacity) {
19789100 1693 mk_sense_buffer(devi, ILLEGAL_REQUEST, ADDR_OUT_OF_RANGE, 0);
1da177e4
LT		 1694 return check_condition_result;
1695 }
c65b1445
DG		 1696 /* transfer length excessive (tie in to block limits VPD page) */
1697 if (num > sdebug_store_sectors) {
19789100 1698 mk_sense_buffer(devi, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB, 0);
c65b1445
DG		 1699 return check_condition_result;
1700 }
19789100
FT		 1701 return 0;
1702}
1703
a4517511 1704/* Returns number of bytes copied or -1 if error. */
19789100
FT		 1705static int do_device_access(struct scsi_cmnd *scmd,
1706 struct sdebug_dev_info *devi,
1707 unsigned long long lba, unsigned int num, int write)
1708{
1709 int ret;
a361cc00 1710 unsigned long long block, rest = 0;
a4517511
AM		 1711 struct scsi_data_buffer *sdb;
1712 enum dma_data_direction dir;
1713 size_t (*func)(struct scatterlist *, unsigned int, void *, size_t,
1714 off_t);
1715
1716 if (write) {
1717 sdb = scsi_out(scmd);
1718 dir = DMA_TO_DEVICE;
1719 func = sg_pcopy_to_buffer;
1720 } else {
1721 sdb = scsi_in(scmd);
1722 dir = DMA_FROM_DEVICE;
1723 func = sg_pcopy_from_buffer;
1724 }
19789100 1725
a4517511
AM		 1726 if (!sdb->length)
1727 return 0;
1728 if (!(scsi_bidi_cmnd(scmd) || scmd->sc_data_direction == dir))
1729 return -1;
19789100
FT		 1730
1731 block = do_div(lba, sdebug_store_sectors);
1732 if (block + num > sdebug_store_sectors)
1733 rest = block + num - sdebug_store_sectors;
1734
a4517511
AM		 1735 ret = func(sdb->table.sgl, sdb->table.nents,
1736 fake_storep + (block * scsi_debug_sector_size),
1737 (num - rest) * scsi_debug_sector_size, 0);
1738 if (ret != (num - rest) * scsi_debug_sector_size)
1739 return ret;
1740
1741 if (rest) {
1742 ret += func(sdb->table.sgl, sdb->table.nents,
1743 fake_storep, rest * scsi_debug_sector_size,
1744 (num - rest) * scsi_debug_sector_size);
1745 }
19789100
FT		 1746
1747 return ret;
1748}
1749
51d648af 1750static __be16 dif_compute_csum(const void *buf, int len)
beb40ea4 1751{
51d648af 1752 __be16 csum;
beb40ea4 1753
51d648af
AM		 1754 if (scsi_debug_guard)
1755 csum = (__force __be16)ip_compute_csum(buf, len);
1756 else
beb40ea4 1757 csum = cpu_to_be16(crc_t10dif(buf, len));
51d648af 1758
beb40ea4
AM		 1759 return csum;
1760}
1761
1762static int dif_verify(struct sd_dif_tuple *sdt, const void *data,
1763 sector_t sector, u32 ei_lba)
1764{
51d648af 1765 __be16 csum = dif_compute_csum(data, scsi_debug_sector_size);
beb40ea4
AM		 1766
1767 if (sdt->guard_tag != csum) {
1768 pr_err("%s: GUARD check failed on sector %lu rcvd 0x%04x, data 0x%04x\n",
1769 __func__,
1770 (unsigned long)sector,
1771 be16_to_cpu(sdt->guard_tag),
1772 be16_to_cpu(csum));
1773 return 0x01;
1774 }
1775 if (scsi_debug_dif == SD_DIF_TYPE1_PROTECTION &&
1776 be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) {
1777 pr_err("%s: REF check failed on sector %lu\n",
1778 __func__, (unsigned long)sector);
1779 return 0x03;
1780 }
1781 if (scsi_debug_dif == SD_DIF_TYPE2_PROTECTION &&
1782 be32_to_cpu(sdt->ref_tag) != ei_lba) {
1783 pr_err("%s: REF check failed on sector %lu\n",
1784 __func__, (unsigned long)sector);
beb40ea4
AM		 1785 return 0x03;
1786 }
1787 return 0;
1788}
1789
bb8c063c 1790static void dif_copy_prot(struct scsi_cmnd *SCpnt, sector_t sector,
65f72f2a 1791 unsigned int sectors, bool read)
c6a44287 1792{
be4e11be 1793 size_t resid;
c6a44287 1794 void *paddr;
14faa944 1795 const void *dif_store_end = dif_storep + sdebug_store_sectors;
be4e11be 1796 struct sg_mapping_iter miter;
c6a44287 1797
e18d8bea
AM		 1798 /* Bytes of protection data to copy into sgl */
1799 resid = sectors * sizeof(*dif_storep);
c6a44287 1800
be4e11be
AM		 1801 sg_miter_start(&miter, scsi_prot_sglist(SCpnt),
1802 scsi_prot_sg_count(SCpnt), SG_MITER_ATOMIC |
1803 (read ? SG_MITER_TO_SG : SG_MITER_FROM_SG));
1804
1805 while (sg_miter_next(&miter) && resid > 0) {
1806 size_t len = min(miter.length, resid);
14faa944 1807 void *start = dif_store(sector);
be4e11be 1808 size_t rest = 0;
14faa944
AM		 1809
1810 if (dif_store_end < start + len)
1811 rest = start + len - dif_store_end;
c6a44287 1812
be4e11be 1813 paddr = miter.addr;
14faa944 1814
65f72f2a
AM		 1815 if (read)
1816 memcpy(paddr, start, len - rest);
1817 else
1818 memcpy(start, paddr, len - rest);
1819
1820 if (rest) {
1821 if (read)
1822 memcpy(paddr + len - rest, dif_storep, rest);
1823 else
1824 memcpy(dif_storep, paddr + len - rest, rest);
1825 }
c6a44287 1826
e18d8bea 1827 sector += len / sizeof(*dif_storep);
c6a44287 1828 resid -= len;
c6a44287 1829 }
be4e11be 1830 sg_miter_stop(&miter);
bb8c063c
AM		 1831}
1832
1833static int prot_verify_read(struct scsi_cmnd *SCpnt, sector_t start_sec,
1834 unsigned int sectors, u32 ei_lba)
1835{
1836 unsigned int i;
1837 struct sd_dif_tuple *sdt;
1838 sector_t sector;
1839
c45eabec 1840 for (i = 0; i < sectors; i++, ei_lba++) {
bb8c063c
AM		 1841 int ret;
1842
1843 sector = start_sec + i;
1844 sdt = dif_store(sector);
1845
51d648af 1846 if (sdt->app_tag == cpu_to_be16(0xffff))
bb8c063c
AM		 1847 continue;
1848
1849 ret = dif_verify(sdt, fake_store(sector), sector, ei_lba);
1850 if (ret) {
1851 dif_errors++;
1852 return ret;
1853 }
bb8c063c 1854 }
c6a44287 1855
65f72f2a 1856 dif_copy_prot(SCpnt, start_sec, sectors, true);
c6a44287
MP		 1857 dix_reads++;
1858
1859 return 0;
1860}
1861
19789100 1862static int resp_read(struct scsi_cmnd *SCpnt, unsigned long long lba,
395cef03
MP		 1863 unsigned int num, struct sdebug_dev_info *devip,
1864 u32 ei_lba)
19789100
FT		 1865{
1866 unsigned long iflags;
1867 int ret;
1868
1869 ret = check_device_access_params(devip, lba, num);
1870 if (ret)
1871 return ret;
1872
1da177e4 1873 if ((SCSI_DEBUG_OPT_MEDIUM_ERR & scsi_debug_opts) &&
32f7ef73 1874 (lba <= (OPT_MEDIUM_ERR_ADDR + OPT_MEDIUM_ERR_NUM - 1)) &&
c65b1445
DG		 1875 ((lba + num) > OPT_MEDIUM_ERR_ADDR)) {
1876 /* claim unrecoverable read error */
32f7ef73 1877 mk_sense_buffer(devip, MEDIUM_ERROR, UNRECOVERED_READ_ERR, 0);
c65b1445
DG		 1878 /* set info field and valid bit for fixed descriptor */
1879 if (0x70 == (devip->sense_buff[0] & 0x7f)) {
1880 devip->sense_buff[0] |= 0x80; /* Valid bit */
32f7ef73
DG		 1881 ret = (lba < OPT_MEDIUM_ERR_ADDR)
1882 ? OPT_MEDIUM_ERR_ADDR : (int)lba;
c65b1445
DG		 1883 devip->sense_buff[3] = (ret >> 24) & 0xff;
1884 devip->sense_buff[4] = (ret >> 16) & 0xff;
1885 devip->sense_buff[5] = (ret >> 8) & 0xff;
1886 devip->sense_buff[6] = ret & 0xff;
1887 }
a87e3a67 1888 scsi_set_resid(SCpnt, scsi_bufflen(SCpnt));
1da177e4
LT		 1889 return check_condition_result;
1890 }
c6a44287 1891
6c78cc06
AM		 1892 read_lock_irqsave(&atomic_rw, iflags);
1893
c6a44287
MP		 1894 /* DIX + T10 DIF */
1895 if (scsi_debug_dix && scsi_prot_sg_count(SCpnt)) {
395cef03 1896 int prot_ret = prot_verify_read(SCpnt, lba, num, ei_lba);
c6a44287
MP		 1897
1898 if (prot_ret) {
6c78cc06 1899 read_unlock_irqrestore(&atomic_rw, iflags);
c6a44287
MP		 1900 mk_sense_buffer(devip, ABORTED_COMMAND, 0x10, prot_ret);
1901 return illegal_condition_result;
1902 }
1903 }
1904
19789100 1905 ret = do_device_access(SCpnt, devip, lba, num, 0);
1da177e4 1906 read_unlock_irqrestore(&atomic_rw, iflags);
a4517511
AM		 1907 if (ret == -1)
1908 return DID_ERROR << 16;
1909
1910 scsi_in(SCpnt)->resid = scsi_bufflen(SCpnt) - ret;
1911
1912 return 0;
1da177e4
LT		 1913}
1914
c6a44287
MP		 1915void dump_sector(unsigned char *buf, int len)
1916{
1917 int i, j;
1918
1919 printk(KERN_ERR ">>> Sector Dump <<<\n");
1920
1921 for (i = 0 ; i < len ; i += 16) {
1922 printk(KERN_ERR "%04d: ", i);
1923
1924 for (j = 0 ; j < 16 ; j++) {
1925 unsigned char c = buf[i+j];
1926 if (c >= 0x20 && c < 0x7e)
1927 printk(" %c ", buf[i+j]);
1928 else
1929 printk("%02x ", buf[i+j]);
1930 }
1931
1932 printk("\n");
1933 }
1934}
1935
1936static int prot_verify_write(struct scsi_cmnd *SCpnt, sector_t start_sec,
395cef03 1937 unsigned int sectors, u32 ei_lba)
c6a44287 1938{
be4e11be 1939 int ret;
c6a44287 1940 struct sd_dif_tuple *sdt;
be4e11be 1941 void *daddr;
65f72f2a 1942 sector_t sector = start_sec;
c6a44287 1943 int ppage_offset;
be4e11be
AM		 1944 int dpage_offset;
1945 struct sg_mapping_iter diter;
1946 struct sg_mapping_iter piter;
c6a44287 1947
c6a44287
MP		 1948 BUG_ON(scsi_sg_count(SCpnt) == 0);
1949 BUG_ON(scsi_prot_sg_count(SCpnt) == 0);
1950
be4e11be
AM		 1951 sg_miter_start(&piter, scsi_prot_sglist(SCpnt),
1952 scsi_prot_sg_count(SCpnt),
1953 SG_MITER_ATOMIC | SG_MITER_FROM_SG);
1954 sg_miter_start(&diter, scsi_sglist(SCpnt), scsi_sg_count(SCpnt),
1955 SG_MITER_ATOMIC | SG_MITER_FROM_SG);
1956
1957 /* For each protection page */
1958 while (sg_miter_next(&piter)) {
1959 dpage_offset = 0;
1960 if (WARN_ON(!sg_miter_next(&diter))) {
1961 ret = 0x01;
1962 goto out;
1963 }
c6a44287 1964
be4e11be
AM		 1965 for (ppage_offset = 0; ppage_offset < piter.length;
1966 ppage_offset += sizeof(struct sd_dif_tuple)) {
c6a44287 1967 /* If we're at the end of the current
be4e11be 1968 * data page advance to the next one
c6a44287 1969 */
be4e11be
AM		 1970 if (dpage_offset >= diter.length) {
1971 if (WARN_ON(!sg_miter_next(&diter))) {
1972 ret = 0x01;
1973 goto out;
1974 }
1975 dpage_offset = 0;
c6a44287
MP		 1976 }
1977
be4e11be
AM		 1978 sdt = piter.addr + ppage_offset;
1979 daddr = diter.addr + dpage_offset;
c6a44287 1980
be4e11be 1981 ret = dif_verify(sdt, daddr, sector, ei_lba);
beb40ea4 1982 if (ret) {
be4e11be 1983 dump_sector(daddr, scsi_debug_sector_size);
395cef03
MP		 1984 goto out;
1985 }
1986
c6a44287 1987 sector++;
395cef03 1988 ei_lba++;
be4e11be 1989 dpage_offset += scsi_debug_sector_size;
c6a44287 1990 }
be4e11be
AM		 1991 diter.consumed = dpage_offset;
1992 sg_miter_stop(&diter);
c6a44287 1993 }
be4e11be 1994 sg_miter_stop(&piter);
c6a44287 1995
65f72f2a 1996 dif_copy_prot(SCpnt, start_sec, sectors, false);
c6a44287
MP		 1997 dix_writes++;
1998
1999 return 0;
2000
2001out:
2002 dif_errors++;
be4e11be
AM		 2003 sg_miter_stop(&diter);
2004 sg_miter_stop(&piter);
c6a44287
MP		 2005 return ret;
2006}
2007
b90ebc3d
AM		 2008static unsigned long lba_to_map_index(sector_t lba)
2009{
2010 if (scsi_debug_unmap_alignment) {
2011 lba += scsi_debug_unmap_granularity -
2012 scsi_debug_unmap_alignment;
2013 }
2014 do_div(lba, scsi_debug_unmap_granularity);
2015
2016 return lba;
2017}
2018
2019static sector_t map_index_to_lba(unsigned long index)
44d92694 2020{
a027b5b9
AM		 2021 sector_t lba = index * scsi_debug_unmap_granularity;
2022
2023 if (scsi_debug_unmap_alignment) {
2024 lba -= scsi_debug_unmap_granularity -
2025 scsi_debug_unmap_alignment;
2026 }
2027
2028 return lba;
b90ebc3d 2029}
44d92694 2030
b90ebc3d
AM		 2031static unsigned int map_state(sector_t lba, unsigned int *num)
2032{
2033 sector_t end;
2034 unsigned int mapped;
2035 unsigned long index;
2036 unsigned long next;
44d92694 2037
b90ebc3d
AM		 2038 index = lba_to_map_index(lba);
2039 mapped = test_bit(index, map_storep);
44d92694
MP		 2040
2041 if (mapped)
b90ebc3d 2042 next = find_next_zero_bit(map_storep, map_size, index);
44d92694 2043 else
b90ebc3d 2044 next = find_next_bit(map_storep, map_size, index);
44d92694 2045
b90ebc3d 2046 end = min_t(sector_t, sdebug_store_sectors, map_index_to_lba(next));
44d92694
MP		 2047 *num = end - lba;
2048
2049 return mapped;
2050}
2051
2052static void map_region(sector_t lba, unsigned int len)
2053{
44d92694
MP		 2054 sector_t end = lba + len;
2055
44d92694 2056 while (lba < end) {
b90ebc3d 2057 unsigned long index = lba_to_map_index(lba);
44d92694 2058
b90ebc3d
AM		 2059 if (index < map_size)
2060 set_bit(index, map_storep);
44d92694 2061
b90ebc3d 2062 lba = map_index_to_lba(index + 1);
44d92694
MP		 2063 }
2064}
2065
2066static void unmap_region(sector_t lba, unsigned int len)
2067{
44d92694
MP		 2068 sector_t end = lba + len;
2069
44d92694 2070 while (lba < end) {
b90ebc3d 2071 unsigned long index = lba_to_map_index(lba);
44d92694 2072
b90ebc3d
AM		 2073 if (lba == map_index_to_lba(index) &&
2074 lba + scsi_debug_unmap_granularity <= end &&
2075 index < map_size) {
2076 clear_bit(index, map_storep);
2077 if (scsi_debug_lbprz) {
be1dd78d 2078 memset(fake_storep +
cc34a8e6
AM		 2079 lba * scsi_debug_sector_size, 0,
2080 scsi_debug_sector_size *
2081 scsi_debug_unmap_granularity);
b90ebc3d 2082 }
e9926b43
AM		 2083 if (dif_storep) {
2084 memset(dif_storep + lba, 0xff,
2085 sizeof(*dif_storep) *
2086 scsi_debug_unmap_granularity);
2087 }
be1dd78d 2088 }
b90ebc3d 2089 lba = map_index_to_lba(index + 1);
44d92694
MP		 2090 }
2091}
2092
19789100 2093static int resp_write(struct scsi_cmnd *SCpnt, unsigned long long lba,
395cef03
MP		 2094 unsigned int num, struct sdebug_dev_info *devip,
2095 u32 ei_lba)
1da177e4
LT		 2096{
2097 unsigned long iflags;
19789100 2098 int ret;
1da177e4 2099
19789100
FT		 2100 ret = check_device_access_params(devip, lba, num);
2101 if (ret)
2102 return ret;
1da177e4 2103
6c78cc06
AM		 2104 write_lock_irqsave(&atomic_rw, iflags);
2105
c6a44287
MP		 2106 /* DIX + T10 DIF */
2107 if (scsi_debug_dix && scsi_prot_sg_count(SCpnt)) {
395cef03 2108 int prot_ret = prot_verify_write(SCpnt, lba, num, ei_lba);
c6a44287
MP		 2109
2110 if (prot_ret) {
6c78cc06 2111 write_unlock_irqrestore(&atomic_rw, iflags);
c6a44287
MP		 2112 mk_sense_buffer(devip, ILLEGAL_REQUEST, 0x10, prot_ret);
2113 return illegal_condition_result;
2114 }
2115 }
2116
19789100 2117 ret = do_device_access(SCpnt, devip, lba, num, 1);
9ed8d3dc 2118 if (scsi_debug_lbp())
44d92694 2119 map_region(lba, num);
1da177e4 2120 write_unlock_irqrestore(&atomic_rw, iflags);
19789100 2121 if (-1 == ret)
1da177e4 2122 return (DID_ERROR << 16);
597136ab 2123 else if ((ret < (num * scsi_debug_sector_size)) &&
1da177e4 2124 (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts))
c65b1445 2125 printk(KERN_INFO "scsi_debug: write: cdb indicated=%u, "
597136ab 2126 " IO sent=%d bytes\n", num * scsi_debug_sector_size, ret);
44d92694
MP		 2127
2128 return 0;
2129}
2130
2131static int resp_write_same(struct scsi_cmnd *scmd, unsigned long long lba,
2132 unsigned int num, struct sdebug_dev_info *devip,
2133 u32 ei_lba, unsigned int unmap)
2134{
2135 unsigned long iflags;
2136 unsigned long long i;
2137 int ret;
2138
2139 ret = check_device_access_params(devip, lba, num);
2140 if (ret)
2141 return ret;
2142
5b94e232
MP		 2143 if (num > scsi_debug_write_same_length) {
2144 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
2145 0);
2146 return check_condition_result;
2147 }
2148
44d92694
MP		 2149 write_lock_irqsave(&atomic_rw, iflags);
2150
9ed8d3dc 2151 if (unmap && scsi_debug_lbp()) {
44d92694
MP		 2152 unmap_region(lba, num);
2153 goto out;
2154 }
2155
2156 /* Else fetch one logical block */
2157 ret = fetch_to_dev_buffer(scmd,
2158 fake_storep + (lba * scsi_debug_sector_size),
2159 scsi_debug_sector_size);
2160
2161 if (-1 == ret) {
2162 write_unlock_irqrestore(&atomic_rw, iflags);
2163 return (DID_ERROR << 16);
2164 } else if ((ret < (num * scsi_debug_sector_size)) &&
2165 (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts))
2166 printk(KERN_INFO "scsi_debug: write same: cdb indicated=%u, "
2167 " IO sent=%d bytes\n", num * scsi_debug_sector_size, ret);
2168
2169 /* Copy first sector to remaining blocks */
2170 for (i = 1 ; i < num ; i++)
2171 memcpy(fake_storep + ((lba + i) * scsi_debug_sector_size),
2172 fake_storep + (lba * scsi_debug_sector_size),
2173 scsi_debug_sector_size);
2174
9ed8d3dc 2175 if (scsi_debug_lbp())
44d92694
MP		 2176 map_region(lba, num);
2177out:
2178 write_unlock_irqrestore(&atomic_rw, iflags);
2179
1da177e4
LT		 2180 return 0;
2181}
2182
44d92694
MP		 2183struct unmap_block_desc {
2184 __be64 lba;
2185 __be32 blocks;
2186 __be32 __reserved;
2187};
2188
2189static int resp_unmap(struct scsi_cmnd * scmd, struct sdebug_dev_info * devip)
2190{
2191 unsigned char *buf;
2192 struct unmap_block_desc *desc;
2193 unsigned int i, payload_len, descriptors;
2194 int ret;
6c78cc06 2195 unsigned long iflags;
44d92694
MP		 2196
2197 ret = check_readiness(scmd, 1, devip);
2198 if (ret)
2199 return ret;
2200
2201 payload_len = get_unaligned_be16(&scmd->cmnd[7]);
2202 BUG_ON(scsi_bufflen(scmd) != payload_len);
2203
2204 descriptors = (payload_len - 8) / 16;
2205
2206 buf = kmalloc(scsi_bufflen(scmd), GFP_ATOMIC);
2207 if (!buf)
2208 return check_condition_result;
2209
2210 scsi_sg_copy_to_buffer(scmd, buf, scsi_bufflen(scmd));
2211
2212 BUG_ON(get_unaligned_be16(&buf[0]) != payload_len - 2);
2213 BUG_ON(get_unaligned_be16(&buf[2]) != descriptors * 16);
2214
2215 desc = (void *)&buf[8];
2216
6c78cc06
AM		 2217 write_lock_irqsave(&atomic_rw, iflags);
2218
44d92694
MP		 2219 for (i = 0 ; i < descriptors ; i++) {
2220 unsigned long long lba = get_unaligned_be64(&desc[i].lba);
2221 unsigned int num = get_unaligned_be32(&desc[i].blocks);
2222
2223 ret = check_device_access_params(devip, lba, num);
2224 if (ret)
2225 goto out;
2226
2227 unmap_region(lba, num);
2228 }
2229
2230 ret = 0;
2231
2232out:
6c78cc06 2233 write_unlock_irqrestore(&atomic_rw, iflags);
44d92694
MP		 2234 kfree(buf);
2235
2236 return ret;
2237}
2238
2239#define SDEBUG_GET_LBA_STATUS_LEN 32
2240
2241static int resp_get_lba_status(struct scsi_cmnd * scmd,
2242 struct sdebug_dev_info * devip)
2243{
2244 unsigned long long lba;
2245 unsigned int alloc_len, mapped, num;
2246 unsigned char arr[SDEBUG_GET_LBA_STATUS_LEN];
2247 int ret;
2248
2249 ret = check_readiness(scmd, 1, devip);
2250 if (ret)
2251 return ret;
2252
2253 lba = get_unaligned_be64(&scmd->cmnd[2]);
2254 alloc_len = get_unaligned_be32(&scmd->cmnd[10]);
2255
2256 if (alloc_len < 24)
2257 return 0;
2258
2259 ret = check_device_access_params(devip, lba, 1);
2260 if (ret)
2261 return ret;
2262
2263 mapped = map_state(lba, &num);
2264
2265 memset(arr, 0, SDEBUG_GET_LBA_STATUS_LEN);
de13e965 2266 put_unaligned_be32(20, &arr[0]); /* Parameter Data Length */
44d92694
MP		 2267 put_unaligned_be64(lba, &arr[8]); /* LBA */
2268 put_unaligned_be32(num, &arr[16]); /* Number of blocks */
2269 arr[20] = !mapped; /* mapped = 0, unmapped = 1 */
2270
2271 return fill_from_dev_buffer(scmd, arr, SDEBUG_GET_LBA_STATUS_LEN);
2272}
2273
c65b1445 2274#define SDEBUG_RLUN_ARR_SZ 256
1da177e4
LT		 2275
2276static int resp_report_luns(struct scsi_cmnd * scp,
2277 struct sdebug_dev_info * devip)
2278{
2279 unsigned int alloc_len;
c65b1445 2280 int lun_cnt, i, upper, num, n, wlun, lun;
1da177e4
LT		 2281 unsigned char *cmd = (unsigned char *)scp->cmnd;
2282 int select_report = (int)cmd[2];
2283 struct scsi_lun *one_lun;
2284 unsigned char arr[SDEBUG_RLUN_ARR_SZ];
c65b1445 2285 unsigned char * max_addr;
1da177e4
LT		 2286
2287 alloc_len = cmd[9] + (cmd[8] << 8) + (cmd[7] << 16) + (cmd[6] << 24);
c65b1445 2288 if ((alloc_len < 4) || (select_report > 2)) {
1da177e4
LT		 2289 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_FIELD_IN_CDB,
2290 0);
2291 return check_condition_result;
2292 }
2293 /* can produce response with up to 16k luns (lun 0 to lun 16383) */
2294 memset(arr, 0, SDEBUG_RLUN_ARR_SZ);
2295 lun_cnt = scsi_debug_max_luns;
c65b1445
DG		 2296 if (1 == select_report)
2297 lun_cnt = 0;
2298 else if (scsi_debug_no_lun_0 && (lun_cnt > 0))
2299 --lun_cnt;
2300 wlun = (select_report > 0) ? 1 : 0;
2301 num = lun_cnt + wlun;
2302 arr[2] = ((sizeof(struct scsi_lun) * num) >> 8) & 0xff;
2303 arr[3] = (sizeof(struct scsi_lun) * num) & 0xff;
2304 n = min((int)((SDEBUG_RLUN_ARR_SZ - 8) /
2305 sizeof(struct scsi_lun)), num);
2306 if (n < num) {
2307 wlun = 0;
2308 lun_cnt = n;
2309 }
1da177e4 2310 one_lun = (struct scsi_lun *) &arr[8];
c65b1445
DG		 2311 max_addr = arr + SDEBUG_RLUN_ARR_SZ;
2312 for (i = 0, lun = (scsi_debug_no_lun_0 ? 1 : 0);
2313 ((i < lun_cnt) && ((unsigned char *)(one_lun + i) < max_addr));
2314 i++, lun++) {
2315 upper = (lun >> 8) & 0x3f;
1da177e4
LT		 2316 if (upper)
2317 one_lun[i].scsi_lun[0] =
2318 (upper | (SAM2_LUN_ADDRESS_METHOD << 6));
c65b1445
DG		 2319 one_lun[i].scsi_lun[1] = lun & 0xff;
2320 }
2321 if (wlun) {
2322 one_lun[i].scsi_lun[0] = (SAM2_WLUN_REPORT_LUNS >> 8) & 0xff;
2323 one_lun[i].scsi_lun[1] = SAM2_WLUN_REPORT_LUNS & 0xff;
2324 i++;
1da177e4 2325 }
c65b1445 2326 alloc_len = (unsigned char *)(one_lun + i) - arr;
1da177e4
LT		 2327 return fill_from_dev_buffer(scp, arr,
2328 min((int)alloc_len, SDEBUG_RLUN_ARR_SZ));
2329}
2330
c639d14e
FT		 2331static int resp_xdwriteread(struct scsi_cmnd *scp, unsigned long long lba,
2332 unsigned int num, struct sdebug_dev_info *devip)
2333{
be4e11be 2334 int j;
c639d14e
FT		 2335 unsigned char *kaddr, *buf;
2336 unsigned int offset;
c639d14e 2337 struct scsi_data_buffer *sdb = scsi_in(scp);
be4e11be 2338 struct sg_mapping_iter miter;
c639d14e
FT		 2339
2340 /* better not to use temporary buffer. */
2341 buf = kmalloc(scsi_bufflen(scp), GFP_ATOMIC);
c5af0db9
AM		 2342 if (!buf) {
2343 mk_sense_buffer(devip, NOT_READY,
2344 LOGICAL_UNIT_COMMUNICATION_FAILURE, 0);
2345 return check_condition_result;
2346 }
c639d14e 2347
21a61829 2348 scsi_sg_copy_to_buffer(scp, buf, scsi_bufflen(scp));
c639d14e
FT		 2349
2350 offset = 0;
be4e11be
AM		 2351 sg_miter_start(&miter, sdb->table.sgl, sdb->table.nents,
2352 SG_MITER_ATOMIC | SG_MITER_TO_SG);
c639d14e 2353
be4e11be
AM		 2354 while (sg_miter_next(&miter)) {
2355 kaddr = miter.addr;
2356 for (j = 0; j < miter.length; j++)
2357 *(kaddr + j) ^= *(buf + offset + j);
c639d14e 2358
be4e11be 2359 offset += miter.length;
c639d14e 2360 }
be4e11be 2361 sg_miter_stop(&miter);
c639d14e
FT		 2362 kfree(buf);
2363
be4e11be 2364 return 0;
c639d14e
FT		 2365}
2366
1da177e4
LT		 2367/* When timer goes off this function is called. */
2368static void timer_intr_handler(unsigned long indx)
2369{
2370 struct sdebug_queued_cmd * sqcp;
2371 unsigned long iflags;
2372
78d4e5a0 2373 if (indx >= scsi_debug_max_queue) {
1da177e4
LT		 2374 printk(KERN_ERR "scsi_debug:timer_intr_handler: indx too "
2375 "large\n");
2376 return;
2377 }
2378 spin_lock_irqsave(&queued_arr_lock, iflags);
2379 sqcp = &queued_arr[(int)indx];
2380 if (! sqcp->in_use) {
2381 printk(KERN_ERR "scsi_debug:timer_intr_handler: Unexpected "
2382 "interrupt\n");
2383 spin_unlock_irqrestore(&queued_arr_lock, iflags);
2384 return;
2385 }
2386 sqcp->in_use = 0;
2387 if (sqcp->done_funct) {
2388 sqcp->a_cmnd->result = sqcp->scsi_result;
2389 sqcp->done_funct(sqcp->a_cmnd); /* callback to mid level */
2390 }
2391 sqcp->done_funct = NULL;
2392 spin_unlock_irqrestore(&queued_arr_lock, iflags);
2393}
2394
1da177e4 2395
8dea0d02
FT		 2396static struct sdebug_dev_info *
2397sdebug_device_create(struct sdebug_host_info *sdbg_host, gfp_t flags)
5cb2fc06
FT		 2398{
2399 struct sdebug_dev_info *devip;
2400
2401 devip = kzalloc(sizeof(*devip), flags);
2402 if (devip) {
2403 devip->sdbg_host = sdbg_host;
2404 list_add_tail(&devip->dev_list, &sdbg_host->dev_info_list);
2405 }
2406 return devip;
2407}
2408
1da177e4
LT		 2409static struct sdebug_dev_info * devInfoReg(struct scsi_device * sdev)
2410{
2411 struct sdebug_host_info * sdbg_host;
2412 struct sdebug_dev_info * open_devip = NULL;
2413 struct sdebug_dev_info * devip =
2414 (struct sdebug_dev_info *)sdev->hostdata;
2415
2416 if (devip)
2417 return devip;
d1e4c9c5
FT		 2418 sdbg_host = *(struct sdebug_host_info **)shost_priv(sdev->host);
2419 if (!sdbg_host) {
1da177e4
LT		 2420 printk(KERN_ERR "Host info NULL\n");
2421 return NULL;
2422 }
2423 list_for_each_entry(devip, &sdbg_host->dev_info_list, dev_list) {
2424 if ((devip->used) && (devip->channel == sdev->channel) &&
2425 (devip->target == sdev->id) &&
2426 (devip->lun == sdev->lun))
2427 return devip;
2428 else {
2429 if ((!devip->used) && (!open_devip))
2430 open_devip = devip;
2431 }
2432 }
5cb2fc06
FT		 2433 if (!open_devip) { /* try and make a new one */
2434 open_devip = sdebug_device_create(sdbg_host, GFP_ATOMIC);
2435 if (!open_devip) {
1da177e4 2436 printk(KERN_ERR "%s: out of memory at line %d\n",
cadbd4a5 2437 __func__, __LINE__);
1da177e4
LT		 2438 return NULL;
2439 }
1da177e4 2440 }
a75869d1
FT		 2441
2442 open_devip->channel = sdev->channel;
2443 open_devip->target = sdev->id;
2444 open_devip->lun = sdev->lun;
2445 open_devip->sdbg_host = sdbg_host;
2446 open_devip->reset = 1;
2447 open_devip->used = 1;
2448 memset(open_devip->sense_buff, 0, SDEBUG_SENSE_LEN);
2449 if (scsi_debug_dsense)
2450 open_devip->sense_buff[0] = 0x72;
2451 else {
2452 open_devip->sense_buff[0] = 0x70;
2453 open_devip->sense_buff[7] = 0xa;
2454 }
2455 if (sdev->lun == SAM2_WLUN_REPORT_LUNS)
2456 open_devip->wlun = SAM2_WLUN_REPORT_LUNS & 0xff;
2457
2458 return open_devip;
1da177e4
LT		 2459}
2460
8dea0d02 2461static int scsi_debug_slave_alloc(struct scsi_device *sdp)
1da177e4 2462{
8dea0d02
FT		 2463 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2464 printk(KERN_INFO "scsi_debug: slave_alloc <%u %u %u %u>\n",
2465 sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
75ad23bc 2466 queue_flag_set_unlocked(QUEUE_FLAG_BIDI, sdp->request_queue);
8dea0d02
FT		 2467 return 0;
2468}
1da177e4 2469
8dea0d02
FT		 2470static int scsi_debug_slave_configure(struct scsi_device *sdp)
2471{
2472 struct sdebug_dev_info *devip;
a34c4e98 2473
8dea0d02
FT		 2474 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2475 printk(KERN_INFO "scsi_debug: slave_configure <%u %u %u %u>\n",
2476 sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
2477 if (sdp->host->max_cmd_len != SCSI_DEBUG_MAX_CMD_LEN)
2478 sdp->host->max_cmd_len = SCSI_DEBUG_MAX_CMD_LEN;
2479 devip = devInfoReg(sdp);
2480 if (NULL == devip)
2481 return 1; /* no resources, will be marked offline */
2482 sdp->hostdata = devip;
2483 if (sdp->host->cmd_per_lun)
2484 scsi_adjust_queue_depth(sdp, SDEBUG_TAGGED_QUEUING,
2485 sdp->host->cmd_per_lun);
2486 blk_queue_max_segment_size(sdp->request_queue, 256 * 1024);
78d4e5a0
DG		 2487 if (scsi_debug_no_uld)
2488 sdp->no_uld_attach = 1;
8dea0d02
FT		 2489 return 0;
2490}
2491
2492static void scsi_debug_slave_destroy(struct scsi_device *sdp)
2493{
2494 struct sdebug_dev_info *devip =
2495 (struct sdebug_dev_info *)sdp->hostdata;
a34c4e98 2496
1da177e4 2497 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
8dea0d02
FT		 2498 printk(KERN_INFO "scsi_debug: slave_destroy <%u %u %u %u>\n",
2499 sdp->host->host_no, sdp->channel, sdp->id, sdp->lun);
2500 if (devip) {
25985edc 2501 /* make this slot available for re-use */
8dea0d02
FT		 2502 devip->used = 0;
2503 sdp->hostdata = NULL;
2504 }
2505}
2506
2507/* Returns 1 if found 'cmnd' and deleted its timer. else returns 0 */
2508static int stop_queued_cmnd(struct scsi_cmnd *cmnd)
2509{
2510 unsigned long iflags;
2511 int k;
2512 struct sdebug_queued_cmd *sqcp;
2513
2514 spin_lock_irqsave(&queued_arr_lock, iflags);
78d4e5a0 2515 for (k = 0; k < scsi_debug_max_queue; ++k) {
8dea0d02
FT		 2516 sqcp = &queued_arr[k];
2517 if (sqcp->in_use && (cmnd == sqcp->a_cmnd)) {
2518 del_timer_sync(&sqcp->cmnd_timer);
2519 sqcp->in_use = 0;
2520 sqcp->a_cmnd = NULL;
2521 break;
2522 }
2523 }
2524 spin_unlock_irqrestore(&queued_arr_lock, iflags);
78d4e5a0 2525 return (k < scsi_debug_max_queue) ? 1 : 0;
8dea0d02
FT		 2526}
2527
2528/* Deletes (stops) timers of all queued commands */
2529static void stop_all_queued(void)
2530{
2531 unsigned long iflags;
2532 int k;
2533 struct sdebug_queued_cmd *sqcp;
2534
2535 spin_lock_irqsave(&queued_arr_lock, iflags);
78d4e5a0 2536 for (k = 0; k < scsi_debug_max_queue; ++k) {
8dea0d02
FT		 2537 sqcp = &queued_arr[k];
2538 if (sqcp->in_use && sqcp->a_cmnd) {
2539 del_timer_sync(&sqcp->cmnd_timer);
2540 sqcp->in_use = 0;
2541 sqcp->a_cmnd = NULL;
2542 }
2543 }
2544 spin_unlock_irqrestore(&queued_arr_lock, iflags);
1da177e4
LT		 2545}
2546
2547static int scsi_debug_abort(struct scsi_cmnd * SCpnt)
2548{
2549 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2550 printk(KERN_INFO "scsi_debug: abort\n");
2551 ++num_aborts;
2552 stop_queued_cmnd(SCpnt);
2553 return SUCCESS;
2554}
2555
2556static int scsi_debug_biosparam(struct scsi_device *sdev,
2557 struct block_device * bdev, sector_t capacity, int *info)
2558{
2559 int res;
2560 unsigned char *buf;
2561
2562 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2563 printk(KERN_INFO "scsi_debug: biosparam\n");
2564 buf = scsi_bios_ptable(bdev);
2565 if (buf) {
2566 res = scsi_partsize(buf, capacity,
2567 &info[2], &info[0], &info[1]);
2568 kfree(buf);
2569 if (! res)
2570 return res;
2571 }
2572 info[0] = sdebug_heads;
2573 info[1] = sdebug_sectors_per;
2574 info[2] = sdebug_cylinders_per;
2575 return 0;
2576}
2577
2578static int scsi_debug_device_reset(struct scsi_cmnd * SCpnt)
2579{
2580 struct sdebug_dev_info * devip;
2581
2582 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2583 printk(KERN_INFO "scsi_debug: device_reset\n");
2584 ++num_dev_resets;
2585 if (SCpnt) {
2586 devip = devInfoReg(SCpnt->device);
2587 if (devip)
2588 devip->reset = 1;
2589 }
2590 return SUCCESS;
2591}
2592
2593static int scsi_debug_bus_reset(struct scsi_cmnd * SCpnt)
2594{
2595 struct sdebug_host_info *sdbg_host;
2596 struct sdebug_dev_info * dev_info;
2597 struct scsi_device * sdp;
2598 struct Scsi_Host * hp;
2599
2600 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2601 printk(KERN_INFO "scsi_debug: bus_reset\n");
2602 ++num_bus_resets;
2603 if (SCpnt && ((sdp = SCpnt->device)) && ((hp = sdp->host))) {
d1e4c9c5 2604 sdbg_host = *(struct sdebug_host_info **)shost_priv(hp);
1da177e4
LT		 2605 if (sdbg_host) {
2606 list_for_each_entry(dev_info,
2607 &sdbg_host->dev_info_list,
2608 dev_list)
2609 dev_info->reset = 1;
2610 }
2611 }
2612 return SUCCESS;
2613}
2614
2615static int scsi_debug_host_reset(struct scsi_cmnd * SCpnt)
2616{
2617 struct sdebug_host_info * sdbg_host;
2618 struct sdebug_dev_info * dev_info;
2619
2620 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
2621 printk(KERN_INFO "scsi_debug: host_reset\n");
2622 ++num_host_resets;
2623 spin_lock(&sdebug_host_list_lock);
2624 list_for_each_entry(sdbg_host, &sdebug_host_list, host_list) {
2625 list_for_each_entry(dev_info, &sdbg_host->dev_info_list,
2626 dev_list)
2627 dev_info->reset = 1;
2628 }
2629 spin_unlock(&sdebug_host_list_lock);
2630 stop_all_queued();
2631 return SUCCESS;
2632}
2633
1da177e4
LT		 2634/* Initializes timers in queued array */
2635static void __init init_all_queued(void)
2636{
2637 unsigned long iflags;
2638 int k;
2639 struct sdebug_queued_cmd * sqcp;
2640
2641 spin_lock_irqsave(&queued_arr_lock, iflags);
78d4e5a0 2642 for (k = 0; k < scsi_debug_max_queue; ++k) {
1da177e4
LT		 2643 sqcp = &queued_arr[k];
2644 init_timer(&sqcp->cmnd_timer);
2645 sqcp->in_use = 0;
2646 sqcp->a_cmnd = NULL;
2647 }
2648 spin_unlock_irqrestore(&queued_arr_lock, iflags);
2649}
2650
f58b0efb 2651static void __init sdebug_build_parts(unsigned char *ramp,
5f2578e5 2652 unsigned long store_size)
1da177e4
LT		 2653{
2654 struct partition * pp;
2655 int starts[SDEBUG_MAX_PARTS + 2];
2656 int sectors_per_part, num_sectors, k;
2657 int heads_by_sects, start_sec, end_sec;
2658
2659 /* assume partition table already zeroed */
f58b0efb 2660 if ((scsi_debug_num_parts < 1) || (store_size < 1048576))
1da177e4
LT		 2661 return;
2662 if (scsi_debug_num_parts > SDEBUG_MAX_PARTS) {
2663 scsi_debug_num_parts = SDEBUG_MAX_PARTS;
2664 printk(KERN_WARNING "scsi_debug:build_parts: reducing "
2665 "partitions to %d\n", SDEBUG_MAX_PARTS);
2666 }
c65b1445 2667 num_sectors = (int)sdebug_store_sectors;
1da177e4
LT		 2668 sectors_per_part = (num_sectors - sdebug_sectors_per)
2669 / scsi_debug_num_parts;
2670 heads_by_sects = sdebug_heads * sdebug_sectors_per;
2671 starts[0] = sdebug_sectors_per;
2672 for (k = 1; k < scsi_debug_num_parts; ++k)
2673 starts[k] = ((k * sectors_per_part) / heads_by_sects)
2674 * heads_by_sects;
2675 starts[scsi_debug_num_parts] = num_sectors;
2676 starts[scsi_debug_num_parts + 1] = 0;
2677
2678 ramp[510] = 0x55; /* magic partition markings */
2679 ramp[511] = 0xAA;
2680 pp = (struct partition *)(ramp + 0x1be);
2681 for (k = 0; starts[k + 1]; ++k, ++pp) {
2682 start_sec = starts[k];
2683 end_sec = starts[k + 1] - 1;
2684 pp->boot_ind = 0;
2685
2686 pp->cyl = start_sec / heads_by_sects;
2687 pp->head = (start_sec - (pp->cyl * heads_by_sects))
2688 / sdebug_sectors_per;
2689 pp->sector = (start_sec % sdebug_sectors_per) + 1;
2690
2691 pp->end_cyl = end_sec / heads_by_sects;
2692 pp->end_head = (end_sec - (pp->end_cyl * heads_by_sects))
2693 / sdebug_sectors_per;
2694 pp->end_sector = (end_sec % sdebug_sectors_per) + 1;
2695
150c3544
AM		 2696 pp->start_sect = cpu_to_le32(start_sec);
2697 pp->nr_sects = cpu_to_le32(end_sec - start_sec + 1);
1da177e4
LT		 2698 pp->sys_ind = 0x83; /* plain Linux partition */
2699 }
2700}
2701
2702static int schedule_resp(struct scsi_cmnd * cmnd,
2703 struct sdebug_dev_info * devip,
2704 done_funct_t done, int scsi_result, int delta_jiff)
2705{
2706 if ((SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) && cmnd) {
2707 if (scsi_result) {
2708 struct scsi_device * sdp = cmnd->device;
2709
c65b1445
DG		 2710 printk(KERN_INFO "scsi_debug: <%u %u %u %u> "
2711 "non-zero result=0x%x\n", sdp->host->host_no,
2712 sdp->channel, sdp->id, sdp->lun, scsi_result);
1da177e4
LT		 2713 }
2714 }
2715 if (cmnd && devip) {
2716 /* simulate autosense by this driver */
2717 if (SAM_STAT_CHECK_CONDITION == (scsi_result & 0xff))
2718 memcpy(cmnd->sense_buffer, devip->sense_buff,
2719 (SCSI_SENSE_BUFFERSIZE > SDEBUG_SENSE_LEN) ?
2720 SDEBUG_SENSE_LEN : SCSI_SENSE_BUFFERSIZE);
2721 }
2722 if (delta_jiff <= 0) {
2723 if (cmnd)
2724 cmnd->result = scsi_result;
2725 if (done)
2726 done(cmnd);
2727 return 0;
2728 } else {
2729 unsigned long iflags;
2730 int k;
2731 struct sdebug_queued_cmd * sqcp = NULL;
2732
2733 spin_lock_irqsave(&queued_arr_lock, iflags);
78d4e5a0 2734 for (k = 0; k < scsi_debug_max_queue; ++k) {
1da177e4
LT		 2735 sqcp = &queued_arr[k];
2736 if (! sqcp->in_use)
2737 break;
2738 }
78d4e5a0 2739 if (k >= scsi_debug_max_queue) {
1da177e4
LT		 2740 spin_unlock_irqrestore(&queued_arr_lock, iflags);
2741 printk(KERN_WARNING "scsi_debug: can_queue exceeded\n");
2742 return 1; /* report busy to mid level */
2743 }
2744 sqcp->in_use = 1;
2745 sqcp->a_cmnd = cmnd;
2746 sqcp->scsi_result = scsi_result;
2747 sqcp->done_funct = done;
2748 sqcp->cmnd_timer.function = timer_intr_handler;
2749 sqcp->cmnd_timer.data = k;
2750 sqcp->cmnd_timer.expires = jiffies + delta_jiff;
2751 add_timer(&sqcp->cmnd_timer);
2752 spin_unlock_irqrestore(&queued_arr_lock, iflags);
2753 if (cmnd)
2754 cmnd->result = 0;
2755 return 0;
2756 }
2757}
23183910
DG		 2758/* Note: The following macros create attribute files in the
2759 /sys/module/scsi_debug/parameters directory. Unfortunately this
2760 driver is unaware of a change and cannot trigger auxiliary actions
2761 as it can when the corresponding attribute in the
2762 /sys/bus/pseudo/drivers/scsi_debug directory is changed.
2763 */
c65b1445 2764module_param_named(add_host, scsi_debug_add_host, int, S_IRUGO | S_IWUSR);
5b94e232 2765module_param_named(ato, scsi_debug_ato, int, S_IRUGO);
0759c666 2766module_param_named(clustering, scsi_debug_clustering, bool, S_IRUGO | S_IWUSR);
c65b1445
DG		 2767module_param_named(delay, scsi_debug_delay, int, S_IRUGO | S_IWUSR);
2768module_param_named(dev_size_mb, scsi_debug_dev_size_mb, int, S_IRUGO);
5b94e232
MP		 2769module_param_named(dif, scsi_debug_dif, int, S_IRUGO);
2770module_param_named(dix, scsi_debug_dix, int, S_IRUGO);
c65b1445
DG		 2771module_param_named(dsense, scsi_debug_dsense, int, S_IRUGO | S_IWUSR);
2772module_param_named(every_nth, scsi_debug_every_nth, int, S_IRUGO | S_IWUSR);
23183910 2773module_param_named(fake_rw, scsi_debug_fake_rw, int, S_IRUGO | S_IWUSR);
68aee7ba 2774module_param_named(guard, scsi_debug_guard, uint, S_IRUGO);
5b94e232
MP		 2775module_param_named(lbpu, scsi_debug_lbpu, int, S_IRUGO);
2776module_param_named(lbpws, scsi_debug_lbpws, int, S_IRUGO);
2777module_param_named(lbpws10, scsi_debug_lbpws10, int, S_IRUGO);
be1dd78d 2778module_param_named(lbprz, scsi_debug_lbprz, int, S_IRUGO);
5b94e232 2779module_param_named(lowest_aligned, scsi_debug_lowest_aligned, int, S_IRUGO);
c65b1445 2780module_param_named(max_luns, scsi_debug_max_luns, int, S_IRUGO | S_IWUSR);
78d4e5a0 2781module_param_named(max_queue, scsi_debug_max_queue, int, S_IRUGO | S_IWUSR);
c65b1445 2782module_param_named(no_lun_0, scsi_debug_no_lun_0, int, S_IRUGO | S_IWUSR);
78d4e5a0 2783module_param_named(no_uld, scsi_debug_no_uld, int, S_IRUGO);
c65b1445
DG		 2784module_param_named(num_parts, scsi_debug_num_parts, int, S_IRUGO);
2785module_param_named(num_tgts, scsi_debug_num_tgts, int, S_IRUGO | S_IWUSR);
5b94e232 2786module_param_named(opt_blks, scsi_debug_opt_blks, int, S_IRUGO);
c65b1445 2787module_param_named(opts, scsi_debug_opts, int, S_IRUGO | S_IWUSR);
5b94e232 2788module_param_named(physblk_exp, scsi_debug_physblk_exp, int, S_IRUGO);
c65b1445 2789module_param_named(ptype, scsi_debug_ptype, int, S_IRUGO | S_IWUSR);
d986788b 2790module_param_named(removable, scsi_debug_removable, bool, S_IRUGO | S_IWUSR);
c65b1445 2791module_param_named(scsi_level, scsi_debug_scsi_level, int, S_IRUGO);
597136ab 2792module_param_named(sector_size, scsi_debug_sector_size, int, S_IRUGO);
5b94e232
MP		 2793module_param_named(unmap_alignment, scsi_debug_unmap_alignment, int, S_IRUGO);
2794module_param_named(unmap_granularity, scsi_debug_unmap_granularity, int, S_IRUGO);
44d92694
MP		 2795module_param_named(unmap_max_blocks, scsi_debug_unmap_max_blocks, int, S_IRUGO);
2796module_param_named(unmap_max_desc, scsi_debug_unmap_max_desc, int, S_IRUGO);
5b94e232
MP		 2797module_param_named(virtual_gb, scsi_debug_virtual_gb, int, S_IRUGO | S_IWUSR);
2798module_param_named(vpd_use_hostno, scsi_debug_vpd_use_hostno, int,
2799 S_IRUGO | S_IWUSR);
2800module_param_named(write_same_length, scsi_debug_write_same_length, int,
2801 S_IRUGO | S_IWUSR);
1da177e4
LT		 2802
2803MODULE_AUTHOR("Eric Youngdale + Douglas Gilbert");
2804MODULE_DESCRIPTION("SCSI debug adapter driver");
2805MODULE_LICENSE("GPL");
2806MODULE_VERSION(SCSI_DEBUG_VERSION);
2807
2808MODULE_PARM_DESC(add_host, "0..127 hosts allowed(def=1)");
5b94e232 2809MODULE_PARM_DESC(ato, "application tag ownership: 0=disk 1=host (def=1)");
0759c666 2810MODULE_PARM_DESC(clustering, "when set enables larger transfers (def=0)");
1da177e4 2811MODULE_PARM_DESC(delay, "# of jiffies to delay response(def=1)");
c65b1445 2812MODULE_PARM_DESC(dev_size_mb, "size in MB of ram shared by devs(def=8)");
5b94e232
MP		 2813MODULE_PARM_DESC(dif, "data integrity field type: 0-3 (def=0)");
2814MODULE_PARM_DESC(dix, "data integrity extensions mask (def=0)");
c65b1445 2815MODULE_PARM_DESC(dsense, "use descriptor sense format(def=0 -> fixed)");
beb87c33 2816MODULE_PARM_DESC(every_nth, "timeout every nth command(def=0)");
23183910 2817MODULE_PARM_DESC(fake_rw, "fake reads/writes instead of copying (def=0)");
5b94e232
MP		 2818MODULE_PARM_DESC(guard, "protection checksum: 0=crc, 1=ip (def=0)");
2819MODULE_PARM_DESC(lbpu, "enable LBP, support UNMAP command (def=0)");
2820MODULE_PARM_DESC(lbpws, "enable LBP, support WRITE SAME(16) with UNMAP bit (def=0)");
2821MODULE_PARM_DESC(lbpws10, "enable LBP, support WRITE SAME(10) with UNMAP bit (def=0)");
be1dd78d 2822MODULE_PARM_DESC(lbprz, "unmapped blocks return 0 on read (def=1)");
5b94e232 2823MODULE_PARM_DESC(lowest_aligned, "lowest aligned lba (def=0)");
c65b1445 2824MODULE_PARM_DESC(max_luns, "number of LUNs per target to simulate(def=1)");
78d4e5a0 2825MODULE_PARM_DESC(max_queue, "max number of queued commands (1 to 255(def))");
c65b1445 2826MODULE_PARM_DESC(no_lun_0, "no LU number 0 (def=0 -> have lun 0)");
78d4e5a0 2827MODULE_PARM_DESC(no_uld, "stop ULD (e.g. sd driver) attaching (def=0))");
1da177e4 2828MODULE_PARM_DESC(num_parts, "number of partitions(def=0)");
c65b1445 2829MODULE_PARM_DESC(num_tgts, "number of targets per host to simulate(def=1)");
5b94e232 2830MODULE_PARM_DESC(opt_blks, "optimal transfer length in block (def=64)");
6f3cbf55 2831MODULE_PARM_DESC(opts, "1->noise, 2->medium_err, 4->timeout, 8->recovered_err... (def=0)");
5b94e232 2832MODULE_PARM_DESC(physblk_exp, "physical block exponent (def=0)");
1da177e4 2833MODULE_PARM_DESC(ptype, "SCSI peripheral type(def=0[disk])");
d986788b 2834MODULE_PARM_DESC(removable, "claim to have removable media (def=0)");
1da177e4 2835MODULE_PARM_DESC(scsi_level, "SCSI level to simulate(def=5[SPC-3])");
ea61fca5 2836MODULE_PARM_DESC(sector_size, "logical block size in bytes (def=512)");
5b94e232
MP		 2837MODULE_PARM_DESC(unmap_alignment, "lowest aligned thin provisioning lba (def=0)");
2838MODULE_PARM_DESC(unmap_granularity, "thin provisioning granularity in blocks (def=1)");
6014759c
MP		 2839MODULE_PARM_DESC(unmap_max_blocks, "max # of blocks can be unmapped in one cmd (def=0xffffffff)");
2840MODULE_PARM_DESC(unmap_max_desc, "max # of ranges that can be unmapped in one cmd (def=256)");
5b94e232
MP		 2841MODULE_PARM_DESC(virtual_gb, "virtual gigabyte size (def=0 -> use dev_size_mb)");
2842MODULE_PARM_DESC(vpd_use_hostno, "0 -> dev ids ignore hostno (def=1 -> unique dev ids)");
2843MODULE_PARM_DESC(write_same_length, "Maximum blocks per WRITE SAME cmd (def=0xffff)");
1da177e4
LT		 2844
2845static char sdebug_info[256];
2846
2847static const char * scsi_debug_info(struct Scsi_Host * shp)
2848{
2849 sprintf(sdebug_info, "scsi_debug, version %s [%s], "
2850 "dev_size_mb=%d, opts=0x%x", SCSI_DEBUG_VERSION,
2851 scsi_debug_version_date, scsi_debug_dev_size_mb,
2852 scsi_debug_opts);
2853 return sdebug_info;
2854}
2855
2856/* scsi_debug_proc_info
2857 * Used if the driver currently has no own support for /proc/scsi
2858 */
c8ed555a 2859static int scsi_debug_write_info(struct Scsi_Host *host, char *buffer, int length)
1da177e4 2860{
c8ed555a
AV		 2861 char arr[16];
2862 int opts;
2863 int minLen = length > 15 ? 15 : length;
1da177e4 2864
c8ed555a
AV		 2865 if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
2866 return -EACCES;
2867 memcpy(arr, buffer, minLen);
2868 arr[minLen] = '\0';
2869 if (1 != sscanf(arr, "%d", &opts))
2870 return -EINVAL;
2871 scsi_debug_opts = opts;
2872 if (scsi_debug_every_nth != 0)
2873 scsi_debug_cmnd_count = 0;
2874 return length;
2875}
1da177e4 2876
c8ed555a
AV		 2877static int scsi_debug_show_info(struct seq_file *m, struct Scsi_Host *host)
2878{
2879 seq_printf(m, "scsi_debug adapter driver, version "
1da177e4
LT		 2880 "%s [%s]\n"
2881 "num_tgts=%d, shared (ram) size=%d MB, opts=0x%x, "
2882 "every_nth=%d(curr:%d)\n"
2883 "delay=%d, max_luns=%d, scsi_level=%d\n"
2884 "sector_size=%d bytes, cylinders=%d, heads=%d, sectors=%d\n"
2885 "number of aborts=%d, device_reset=%d, bus_resets=%d, "
c6a44287 2886 "host_resets=%d\ndix_reads=%d dix_writes=%d dif_errors=%d\n",
1da177e4
LT		 2887 SCSI_DEBUG_VERSION, scsi_debug_version_date, scsi_debug_num_tgts,
2888 scsi_debug_dev_size_mb, scsi_debug_opts, scsi_debug_every_nth,
2889 scsi_debug_cmnd_count, scsi_debug_delay,
2890 scsi_debug_max_luns, scsi_debug_scsi_level,
597136ab
MP		 2891 scsi_debug_sector_size, sdebug_cylinders_per, sdebug_heads,
2892 sdebug_sectors_per, num_aborts, num_dev_resets, num_bus_resets,
c6a44287 2893 num_host_resets, dix_reads, dix_writes, dif_errors);
c8ed555a 2894 return 0;
1da177e4
LT		 2895}
2896
82069379 2897static ssize_t delay_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 2898{
2899 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_delay);
2900}
2901
82069379
AM		 2902static ssize_t delay_store(struct device_driver *ddp, const char *buf,
2903 size_t count)
1da177e4
LT		 2904{
2905 int delay;
2906 char work[20];
2907
2908 if (1 == sscanf(buf, "%10s", work)) {
2909 if ((1 == sscanf(work, "%d", &delay)) && (delay >= 0)) {
2910 scsi_debug_delay = delay;
2911 return count;
2912 }
2913 }
2914 return -EINVAL;
2915}
82069379 2916static DRIVER_ATTR_RW(delay);
1da177e4 2917
82069379 2918static ssize_t opts_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 2919{
2920 return scnprintf(buf, PAGE_SIZE, "0x%x\n", scsi_debug_opts);
2921}
2922
82069379
AM		 2923static ssize_t opts_store(struct device_driver *ddp, const char *buf,
2924 size_t count)
1da177e4
LT		 2925{
2926 int opts;
2927 char work[20];
2928
2929 if (1 == sscanf(buf, "%10s", work)) {
2930 if (0 == strnicmp(work,"0x", 2)) {
2931 if (1 == sscanf(&work[2], "%x", &opts))
2932 goto opts_done;
2933 } else {
2934 if (1 == sscanf(work, "%d", &opts))
2935 goto opts_done;
2936 }
2937 }
2938 return -EINVAL;
2939opts_done:
2940 scsi_debug_opts = opts;
2941 scsi_debug_cmnd_count = 0;
2942 return count;
2943}
82069379 2944static DRIVER_ATTR_RW(opts);
1da177e4 2945
82069379 2946static ssize_t ptype_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 2947{
2948 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_ptype);
2949}
82069379
AM		 2950static ssize_t ptype_store(struct device_driver *ddp, const char *buf,
2951 size_t count)
1da177e4
LT		 2952{
2953 int n;
2954
2955 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
2956 scsi_debug_ptype = n;
2957 return count;
2958 }
2959 return -EINVAL;
2960}
82069379 2961static DRIVER_ATTR_RW(ptype);
1da177e4 2962
82069379 2963static ssize_t dsense_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 2964{
2965 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dsense);
2966}
82069379
AM		 2967static ssize_t dsense_store(struct device_driver *ddp, const char *buf,
2968 size_t count)
1da177e4
LT		 2969{
2970 int n;
2971
2972 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
2973 scsi_debug_dsense = n;
2974 return count;
2975 }
2976 return -EINVAL;
2977}
82069379 2978static DRIVER_ATTR_RW(dsense);
1da177e4 2979
82069379 2980static ssize_t fake_rw_show(struct device_driver *ddp, char *buf)
23183910
DG		 2981{
2982 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_fake_rw);
2983}
82069379
AM		 2984static ssize_t fake_rw_store(struct device_driver *ddp, const char *buf,
2985 size_t count)
23183910
DG		 2986{
2987 int n;
2988
2989 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
2990 scsi_debug_fake_rw = n;
2991 return count;
2992 }
2993 return -EINVAL;
2994}
82069379 2995static DRIVER_ATTR_RW(fake_rw);
23183910 2996
82069379 2997static ssize_t no_lun_0_show(struct device_driver *ddp, char *buf)
c65b1445
DG		 2998{
2999 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_no_lun_0);
3000}
82069379
AM		 3001static ssize_t no_lun_0_store(struct device_driver *ddp, const char *buf,
3002 size_t count)
c65b1445
DG		 3003{
3004 int n;
3005
3006 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3007 scsi_debug_no_lun_0 = n;
3008 return count;
3009 }
3010 return -EINVAL;
3011}
82069379 3012static DRIVER_ATTR_RW(no_lun_0);
c65b1445 3013
82069379 3014static ssize_t num_tgts_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3015{
3016 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_num_tgts);
3017}
82069379
AM		 3018static ssize_t num_tgts_store(struct device_driver *ddp, const char *buf,
3019 size_t count)
1da177e4
LT		 3020{
3021 int n;
3022
3023 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3024 scsi_debug_num_tgts = n;
3025 sdebug_max_tgts_luns();
3026 return count;
3027 }
3028 return -EINVAL;
3029}
82069379 3030static DRIVER_ATTR_RW(num_tgts);
1da177e4 3031
82069379 3032static ssize_t dev_size_mb_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3033{
3034 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dev_size_mb);
3035}
82069379 3036static DRIVER_ATTR_RO(dev_size_mb);
1da177e4 3037
82069379 3038static ssize_t num_parts_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3039{
3040 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_num_parts);
3041}
82069379 3042static DRIVER_ATTR_RO(num_parts);
1da177e4 3043
82069379 3044static ssize_t every_nth_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3045{
3046 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_every_nth);
3047}
82069379
AM		 3048static ssize_t every_nth_store(struct device_driver *ddp, const char *buf,
3049 size_t count)
1da177e4
LT		 3050{
3051 int nth;
3052
3053 if ((count > 0) && (1 == sscanf(buf, "%d", &nth))) {
3054 scsi_debug_every_nth = nth;
3055 scsi_debug_cmnd_count = 0;
3056 return count;
3057 }
3058 return -EINVAL;
3059}
82069379 3060static DRIVER_ATTR_RW(every_nth);
1da177e4 3061
82069379 3062static ssize_t max_luns_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3063{
3064 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_max_luns);
3065}
82069379
AM		 3066static ssize_t max_luns_store(struct device_driver *ddp, const char *buf,
3067 size_t count)
1da177e4
LT		 3068{
3069 int n;
3070
3071 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3072 scsi_debug_max_luns = n;
3073 sdebug_max_tgts_luns();
3074 return count;
3075 }
3076 return -EINVAL;
3077}
82069379 3078static DRIVER_ATTR_RW(max_luns);
1da177e4 3079
82069379 3080static ssize_t max_queue_show(struct device_driver *ddp, char *buf)
78d4e5a0
DG		 3081{
3082 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_max_queue);
3083}
82069379
AM		 3084static ssize_t max_queue_store(struct device_driver *ddp, const char *buf,
3085 size_t count)
78d4e5a0
DG		 3086{
3087 int n;
3088
3089 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n > 0) &&
3090 (n <= SCSI_DEBUG_CANQUEUE)) {
3091 scsi_debug_max_queue = n;
3092 return count;
3093 }
3094 return -EINVAL;
3095}
82069379 3096static DRIVER_ATTR_RW(max_queue);
78d4e5a0 3097
82069379 3098static ssize_t no_uld_show(struct device_driver *ddp, char *buf)
78d4e5a0
DG		 3099{
3100 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_no_uld);
3101}
82069379 3102static DRIVER_ATTR_RO(no_uld);
78d4e5a0 3103
82069379 3104static ssize_t scsi_level_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3105{
3106 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_scsi_level);
3107}
82069379 3108static DRIVER_ATTR_RO(scsi_level);
1da177e4 3109
82069379 3110static ssize_t virtual_gb_show(struct device_driver *ddp, char *buf)
c65b1445
DG		 3111{
3112 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_virtual_gb);
3113}
82069379
AM		 3114static ssize_t virtual_gb_store(struct device_driver *ddp, const char *buf,
3115 size_t count)
c65b1445
DG		 3116{
3117 int n;
3118
3119 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3120 scsi_debug_virtual_gb = n;
28898873
FT		 3121
3122 sdebug_capacity = get_sdebug_capacity();
3123
c65b1445
DG		 3124 return count;
3125 }
3126 return -EINVAL;
3127}
82069379 3128static DRIVER_ATTR_RW(virtual_gb);
c65b1445 3129
82069379 3130static ssize_t add_host_show(struct device_driver *ddp, char *buf)
1da177e4
LT		 3131{
3132 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_add_host);
3133}
3134
82069379
AM		 3135static ssize_t add_host_store(struct device_driver *ddp, const char *buf,
3136 size_t count)
1da177e4 3137{
f3df41cf 3138 int delta_hosts;
1da177e4 3139
f3df41cf 3140 if (sscanf(buf, "%d", &delta_hosts) != 1)
1da177e4 3141 return -EINVAL;
1da177e4
LT		 3142 if (delta_hosts > 0) {
3143 do {
3144 sdebug_add_adapter();
3145 } while (--delta_hosts);
3146 } else if (delta_hosts < 0) {
3147 do {
3148 sdebug_remove_adapter();
3149 } while (++delta_hosts);
3150 }
3151 return count;
3152}
82069379 3153static DRIVER_ATTR_RW(add_host);
1da177e4 3154
82069379 3155static ssize_t vpd_use_hostno_show(struct device_driver *ddp, char *buf)
23183910
DG		 3156{
3157 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_vpd_use_hostno);
3158}
82069379
AM		 3159static ssize_t vpd_use_hostno_store(struct device_driver *ddp, const char *buf,
3160 size_t count)
23183910
DG		 3161{
3162 int n;
3163
3164 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3165 scsi_debug_vpd_use_hostno = n;
3166 return count;
3167 }
3168 return -EINVAL;
3169}
82069379 3170static DRIVER_ATTR_RW(vpd_use_hostno);
23183910 3171
82069379 3172static ssize_t sector_size_show(struct device_driver *ddp, char *buf)
597136ab
MP		 3173{
3174 return scnprintf(buf, PAGE_SIZE, "%u\n", scsi_debug_sector_size);
3175}
82069379 3176static DRIVER_ATTR_RO(sector_size);
597136ab 3177
82069379 3178static ssize_t dix_show(struct device_driver *ddp, char *buf)
c6a44287
MP		 3179{
3180 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dix);
3181}
82069379 3182static DRIVER_ATTR_RO(dix);
c6a44287 3183
82069379 3184static ssize_t dif_show(struct device_driver *ddp, char *buf)
c6a44287
MP		 3185{
3186 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_dif);
3187}
82069379 3188static DRIVER_ATTR_RO(dif);
c6a44287 3189
82069379 3190static ssize_t guard_show(struct device_driver *ddp, char *buf)
c6a44287 3191{
68aee7ba 3192 return scnprintf(buf, PAGE_SIZE, "%u\n", scsi_debug_guard);
c6a44287 3193}
82069379 3194static DRIVER_ATTR_RO(guard);
c6a44287 3195
82069379 3196static ssize_t ato_show(struct device_driver *ddp, char *buf)
c6a44287
MP		 3197{
3198 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_ato);
3199}
82069379 3200static DRIVER_ATTR_RO(ato);
c6a44287 3201
82069379 3202static ssize_t map_show(struct device_driver *ddp, char *buf)
44d92694
MP		 3203{
3204 ssize_t count;
3205
5b94e232 3206 if (!scsi_debug_lbp())
44d92694
MP		 3207 return scnprintf(buf, PAGE_SIZE, "0-%u\n",
3208 sdebug_store_sectors);
3209
3210 count = bitmap_scnlistprintf(buf, PAGE_SIZE, map_storep, map_size);
3211
3212 buf[count++] = '\n';
3213 buf[count++] = 0;
3214
3215 return count;
3216}
82069379 3217static DRIVER_ATTR_RO(map);
44d92694 3218
82069379 3219static ssize_t removable_show(struct device_driver *ddp, char *buf)
d986788b
MP		 3220{
3221 return scnprintf(buf, PAGE_SIZE, "%d\n", scsi_debug_removable ? 1 : 0);
3222}
82069379
AM		 3223static ssize_t removable_store(struct device_driver *ddp, const char *buf,
3224 size_t count)
d986788b
MP		 3225{
3226 int n;
3227
3228 if ((count > 0) && (1 == sscanf(buf, "%d", &n)) && (n >= 0)) {
3229 scsi_debug_removable = (n > 0);
3230 return count;
3231 }
3232 return -EINVAL;
3233}
82069379 3234static DRIVER_ATTR_RW(removable);
d986788b 3235
82069379 3236/* Note: The following array creates attribute files in the
23183910
DG		 3237 /sys/bus/pseudo/drivers/scsi_debug directory. The advantage of these
3238 files (over those found in the /sys/module/scsi_debug/parameters
3239 directory) is that auxiliary actions can be triggered when an attribute
3240 is changed. For example see: sdebug_add_host_store() above.
3241 */
6ecaff7f 3242
82069379
AM		 3243static struct attribute *sdebug_drv_attrs[] = {
3244 &driver_attr_delay.attr,
3245 &driver_attr_opts.attr,
3246 &driver_attr_ptype.attr,
3247 &driver_attr_dsense.attr,
3248 &driver_attr_fake_rw.attr,
3249 &driver_attr_no_lun_0.attr,
3250 &driver_attr_num_tgts.attr,
3251 &driver_attr_dev_size_mb.attr,
3252 &driver_attr_num_parts.attr,
3253 &driver_attr_every_nth.attr,
3254 &driver_attr_max_luns.attr,
3255 &driver_attr_max_queue.attr,
3256 &driver_attr_no_uld.attr,
3257 &driver_attr_scsi_level.attr,
3258 &driver_attr_virtual_gb.attr,
3259 &driver_attr_add_host.attr,
3260 &driver_attr_vpd_use_hostno.attr,
3261 &driver_attr_sector_size.attr,
3262 &driver_attr_dix.attr,
3263 &driver_attr_dif.attr,
3264 &driver_attr_guard.attr,
3265 &driver_attr_ato.attr,
3266 &driver_attr_map.attr,
3267 &driver_attr_removable.attr,
3268 NULL,
3269};
3270ATTRIBUTE_GROUPS(sdebug_drv);
1da177e4 3271
11ddceca 3272static struct device *pseudo_primary;
8dea0d02 3273
1da177e4
LT		 3274static int __init scsi_debug_init(void)
3275{
5f2578e5 3276 unsigned long sz;
1da177e4
LT		 3277 int host_to_add;
3278 int k;
6ecaff7f 3279 int ret;
1da177e4 3280
597136ab
MP		 3281 switch (scsi_debug_sector_size) {
3282 case 512:
3283 case 1024:
3284 case 2048:
3285 case 4096:
3286 break;
3287 default:
c6a44287 3288 printk(KERN_ERR "scsi_debug_init: invalid sector_size %d\n",
597136ab
MP		 3289 scsi_debug_sector_size);
3290 return -EINVAL;
3291 }
3292
c6a44287
MP		 3293 switch (scsi_debug_dif) {
3294
3295 case SD_DIF_TYPE0_PROTECTION:
3296 case SD_DIF_TYPE1_PROTECTION:
395cef03 3297 case SD_DIF_TYPE2_PROTECTION:
c6a44287
MP		 3298 case SD_DIF_TYPE3_PROTECTION:
3299 break;
3300
3301 default:
395cef03 3302 printk(KERN_ERR "scsi_debug_init: dif must be 0, 1, 2 or 3\n");
c6a44287
MP		 3303 return -EINVAL;
3304 }
3305
3306 if (scsi_debug_guard > 1) {
3307 printk(KERN_ERR "scsi_debug_init: guard must be 0 or 1\n");
3308 return -EINVAL;
3309 }
3310
3311 if (scsi_debug_ato > 1) {
3312 printk(KERN_ERR "scsi_debug_init: ato must be 0 or 1\n");
3313 return -EINVAL;
3314 }
3315
ea61fca5
MP		 3316 if (scsi_debug_physblk_exp > 15) {
3317 printk(KERN_ERR "scsi_debug_init: invalid physblk_exp %u\n",
3318 scsi_debug_physblk_exp);
3319 return -EINVAL;
3320 }
3321
3322 if (scsi_debug_lowest_aligned > 0x3fff) {
3323 printk(KERN_ERR "scsi_debug_init: lowest_aligned too big: %u\n",
3324 scsi_debug_lowest_aligned);
3325 return -EINVAL;
3326 }
3327
1da177e4
LT		 3328 if (scsi_debug_dev_size_mb < 1)
3329 scsi_debug_dev_size_mb = 1; /* force minimum 1 MB ramdisk */
5f2578e5 3330 sz = (unsigned long)scsi_debug_dev_size_mb * 1048576;
597136ab 3331 sdebug_store_sectors = sz / scsi_debug_sector_size;
28898873 3332 sdebug_capacity = get_sdebug_capacity();
1da177e4
LT		 3333
3334 /* play around with geometry, don't waste too much on track 0 */
3335 sdebug_heads = 8;
3336 sdebug_sectors_per = 32;
3337 if (scsi_debug_dev_size_mb >= 16)
3338 sdebug_heads = 32;
3339 else if (scsi_debug_dev_size_mb >= 256)
3340 sdebug_heads = 64;
3341 sdebug_cylinders_per = (unsigned long)sdebug_capacity /
3342 (sdebug_sectors_per * sdebug_heads);
3343 if (sdebug_cylinders_per >= 1024) {
3344 /* other LLDs do this; implies >= 1GB ram disk ... */
3345 sdebug_heads = 255;
3346 sdebug_sectors_per = 63;
3347 sdebug_cylinders_per = (unsigned long)sdebug_capacity /
3348 (sdebug_sectors_per * sdebug_heads);
3349 }
3350
1da177e4
LT		 3351 fake_storep = vmalloc(sz);
3352 if (NULL == fake_storep) {
3353 printk(KERN_ERR "scsi_debug_init: out of memory, 1\n");
3354 return -ENOMEM;
3355 }
3356 memset(fake_storep, 0, sz);
3357 if (scsi_debug_num_parts > 0)
f58b0efb 3358 sdebug_build_parts(fake_storep, sz);
1da177e4 3359
7cb69d03 3360 if (scsi_debug_dix) {
c6a44287
MP		 3361 int dif_size;
3362
3363 dif_size = sdebug_store_sectors * sizeof(struct sd_dif_tuple);
3364 dif_storep = vmalloc(dif_size);
3365
3366 printk(KERN_ERR "scsi_debug_init: dif_storep %u bytes @ %p\n",
3367 dif_size, dif_storep);
3368
3369 if (dif_storep == NULL) {
3370 printk(KERN_ERR "scsi_debug_init: out of mem. (DIX)\n");
3371 ret = -ENOMEM;
3372 goto free_vm;
3373 }
3374
3375 memset(dif_storep, 0xff, dif_size);
3376 }
3377
5b94e232
MP		 3378 /* Logical Block Provisioning */
3379 if (scsi_debug_lbp()) {
6014759c
MP		 3380 scsi_debug_unmap_max_blocks =
3381 clamp(scsi_debug_unmap_max_blocks, 0U, 0xffffffffU);
3382
3383 scsi_debug_unmap_max_desc =
3384 clamp(scsi_debug_unmap_max_desc, 0U, 256U);
3385
3386 scsi_debug_unmap_granularity =
3387 clamp(scsi_debug_unmap_granularity, 1U, 0xffffffffU);
3388
3389 if (scsi_debug_unmap_alignment &&
ac17078a
AM		 3390 scsi_debug_unmap_granularity <=
3391 scsi_debug_unmap_alignment) {
44d92694 3392 printk(KERN_ERR
ac17078a 3393 "%s: ERR: unmap_granularity <= unmap_alignment\n",
44d92694
MP		 3394 __func__);
3395 return -EINVAL;
3396 }
3397
b90ebc3d
AM		 3398 map_size = lba_to_map_index(sdebug_store_sectors - 1) + 1;
3399 map_storep = vmalloc(BITS_TO_LONGS(map_size) * sizeof(long));
44d92694
MP		 3400
3401 printk(KERN_INFO "scsi_debug_init: %lu provisioning blocks\n",
3402 map_size);
3403
3404 if (map_storep == NULL) {
3405 printk(KERN_ERR "scsi_debug_init: out of mem. (MAP)\n");
3406 ret = -ENOMEM;
3407 goto free_vm;
3408 }
3409
b90ebc3d 3410 bitmap_zero(map_storep, map_size);
44d92694
MP		 3411
3412 /* Map first 1KB for partition table */
3413 if (scsi_debug_num_parts)
3414 map_region(0, 2);
3415 }
3416
9b906779
NB		 3417 pseudo_primary = root_device_register("pseudo_0");
3418 if (IS_ERR(pseudo_primary)) {
3419 printk(KERN_WARNING "scsi_debug: root_device_register() error\n");
3420 ret = PTR_ERR(pseudo_primary);
6ecaff7f
RD		 3421 goto free_vm;
3422 }
3423 ret = bus_register(&pseudo_lld_bus);
3424 if (ret < 0) {
3425 printk(KERN_WARNING "scsi_debug: bus_register error: %d\n",
3426 ret);
3427 goto dev_unreg;
3428 }
3429 ret = driver_register(&sdebug_driverfs_driver);
3430 if (ret < 0) {
3431 printk(KERN_WARNING "scsi_debug: driver_register error: %d\n",
3432 ret);
3433 goto bus_unreg;
3434 }
1da177e4 3435
6ecaff7f 3436 init_all_queued();
1da177e4 3437
1da177e4
LT		 3438 host_to_add = scsi_debug_add_host;
3439 scsi_debug_add_host = 0;
3440
3441 for (k = 0; k < host_to_add; k++) {
3442 if (sdebug_add_adapter()) {
3443 printk(KERN_ERR "scsi_debug_init: "
3444 "sdebug_add_adapter failed k=%d\n", k);
3445 break;
3446 }
3447 }
3448
3449 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) {
3450 printk(KERN_INFO "scsi_debug_init: built %d host(s)\n",
3451 scsi_debug_add_host);
3452 }
3453 return 0;
6ecaff7f 3454
6ecaff7f
RD		 3455bus_unreg:
3456 bus_unregister(&pseudo_lld_bus);
3457dev_unreg:
9b906779 3458 root_device_unregister(pseudo_primary);
6ecaff7f 3459free_vm:
44d92694
MP		 3460 if (map_storep)
3461 vfree(map_storep);
c6a44287
MP		 3462 if (dif_storep)
3463 vfree(dif_storep);
6ecaff7f
RD		 3464 vfree(fake_storep);
3465
3466 return ret;
1da177e4
LT		 3467}
3468
3469static void __exit scsi_debug_exit(void)
3470{
3471 int k = scsi_debug_add_host;
3472
3473 stop_all_queued();
3474 for (; k; k--)
3475 sdebug_remove_adapter();
1da177e4
LT		 3476 driver_unregister(&sdebug_driverfs_driver);
3477 bus_unregister(&pseudo_lld_bus);
9b906779 3478 root_device_unregister(pseudo_primary);
1da177e4 3479
c6a44287
MP		 3480 if (dif_storep)
3481 vfree(dif_storep);
3482
1da177e4
LT		 3483 vfree(fake_storep);
3484}
3485
3486device_initcall(scsi_debug_init);
3487module_exit(scsi_debug_exit);
3488
1da177e4
LT		 3489static void sdebug_release_adapter(struct device * dev)
3490{
3491 struct sdebug_host_info *sdbg_host;
3492
3493 sdbg_host = to_sdebug_host(dev);
3494 kfree(sdbg_host);
3495}
3496
3497static int sdebug_add_adapter(void)
3498{
3499 int k, devs_per_host;
3500 int error = 0;
3501 struct sdebug_host_info *sdbg_host;
8b40228f 3502 struct sdebug_dev_info *sdbg_devinfo, *tmp;
1da177e4 3503
c65b1445 3504 sdbg_host = kzalloc(sizeof(*sdbg_host),GFP_KERNEL);
1da177e4
LT		 3505 if (NULL == sdbg_host) {
3506 printk(KERN_ERR "%s: out of memory at line %d\n",
cadbd4a5 3507 __func__, __LINE__);
1da177e4
LT		 3508 return -ENOMEM;
3509 }
3510
1da177e4
LT		 3511 INIT_LIST_HEAD(&sdbg_host->dev_info_list);
3512
3513 devs_per_host = scsi_debug_num_tgts * scsi_debug_max_luns;
3514 for (k = 0; k < devs_per_host; k++) {
5cb2fc06
FT		 3515 sdbg_devinfo = sdebug_device_create(sdbg_host, GFP_KERNEL);
3516 if (!sdbg_devinfo) {
1da177e4 3517 printk(KERN_ERR "%s: out of memory at line %d\n",
cadbd4a5 3518 __func__, __LINE__);
1da177e4
LT		 3519 error = -ENOMEM;
3520 goto clean;
3521 }
1da177e4
LT		 3522 }
3523
3524 spin_lock(&sdebug_host_list_lock);
3525 list_add_tail(&sdbg_host->host_list, &sdebug_host_list);
3526 spin_unlock(&sdebug_host_list_lock);
3527
3528 sdbg_host->dev.bus = &pseudo_lld_bus;
9b906779 3529 sdbg_host->dev.parent = pseudo_primary;
1da177e4 3530 sdbg_host->dev.release = &sdebug_release_adapter;
71610f55 3531 dev_set_name(&sdbg_host->dev, "adapter%d", scsi_debug_add_host);
1da177e4
LT		 3532
3533 error = device_register(&sdbg_host->dev);
3534
3535 if (error)
3536 goto clean;
3537
3538 ++scsi_debug_add_host;
3539 return error;
3540
3541clean:
8b40228f
FT		 3542 list_for_each_entry_safe(sdbg_devinfo, tmp, &sdbg_host->dev_info_list,
3543 dev_list) {
1da177e4
LT		 3544 list_del(&sdbg_devinfo->dev_list);
3545 kfree(sdbg_devinfo);
3546 }
3547
3548 kfree(sdbg_host);
3549 return error;
3550}
3551
3552static void sdebug_remove_adapter(void)
3553{
3554 struct sdebug_host_info * sdbg_host = NULL;
3555
3556 spin_lock(&sdebug_host_list_lock);
3557 if (!list_empty(&sdebug_host_list)) {
3558 sdbg_host = list_entry(sdebug_host_list.prev,
3559 struct sdebug_host_info, host_list);
3560 list_del(&sdbg_host->host_list);
3561 }
3562 spin_unlock(&sdebug_host_list_lock);
3563
3564 if (!sdbg_host)
3565 return;
3566
3567 device_unregister(&sdbg_host->dev);
3568 --scsi_debug_add_host;
3569}
3570
639db475 3571static
f281233d 3572int scsi_debug_queuecommand_lck(struct scsi_cmnd *SCpnt, done_funct_t done)
639db475
FT		 3573{
3574 unsigned char *cmd = (unsigned char *) SCpnt->cmnd;
3575 int len, k;
3576 unsigned int num;
3577 unsigned long long lba;
395cef03 3578 u32 ei_lba;
639db475
FT		 3579 int errsts = 0;
3580 int target = SCpnt->device->id;
3581 struct sdebug_dev_info *devip = NULL;
3582 int inj_recovered = 0;
3583 int inj_transport = 0;
c6a44287
MP		 3584 int inj_dif = 0;
3585 int inj_dix = 0;
639db475 3586 int delay_override = 0;
44d92694 3587 int unmap = 0;
639db475
FT		 3588
3589 scsi_set_resid(SCpnt, 0);
3590 if ((SCSI_DEBUG_OPT_NOISE & scsi_debug_opts) && cmd) {
3591 printk(KERN_INFO "scsi_debug: cmd ");
3592 for (k = 0, len = SCpnt->cmd_len; k < len; ++k)
3593 printk("%02x ", (int)cmd[k]);
3594 printk("\n");
3595 }
3596
3597 if (target == SCpnt->device->host->hostt->this_id) {
3598 printk(KERN_INFO "scsi_debug: initiator's id used as "
3599 "target!\n");
3600 return schedule_resp(SCpnt, NULL, done,
3601 DID_NO_CONNECT << 16, 0);
3602 }
3603
3604 if ((SCpnt->device->lun >= scsi_debug_max_luns) &&
3605 (SCpnt->device->lun != SAM2_WLUN_REPORT_LUNS))
3606 return schedule_resp(SCpnt, NULL, done,
3607 DID_NO_CONNECT << 16, 0);
3608 devip = devInfoReg(SCpnt->device);
3609 if (NULL == devip)
3610 return schedule_resp(SCpnt, NULL, done,
3611 DID_NO_CONNECT << 16, 0);
3612
3613 if ((scsi_debug_every_nth != 0) &&
3614 (++scsi_debug_cmnd_count >= abs(scsi_debug_every_nth))) {
3615 scsi_debug_cmnd_count = 0;
3616 if (scsi_debug_every_nth < -1)
3617 scsi_debug_every_nth = -1;
3618 if (SCSI_DEBUG_OPT_TIMEOUT & scsi_debug_opts)
3619 return 0; /* ignore command causing timeout */
18a4d0a2
MP		 3620 else if (SCSI_DEBUG_OPT_MAC_TIMEOUT & scsi_debug_opts &&
3621 scsi_medium_access_command(SCpnt))
3622 return 0; /* time out reads and writes */
639db475
FT		 3623 else if (SCSI_DEBUG_OPT_RECOVERED_ERR & scsi_debug_opts)
3624 inj_recovered = 1; /* to reads and writes below */
3625 else if (SCSI_DEBUG_OPT_TRANSPORT_ERR & scsi_debug_opts)
3626 inj_transport = 1; /* to reads and writes below */
c6a44287
MP		 3627 else if (SCSI_DEBUG_OPT_DIF_ERR & scsi_debug_opts)
3628 inj_dif = 1; /* to reads and writes below */
3629 else if (SCSI_DEBUG_OPT_DIX_ERR & scsi_debug_opts)
3630 inj_dix = 1; /* to reads and writes below */
639db475
FT		 3631 }
3632
3633 if (devip->wlun) {
3634 switch (*cmd) {
3635 case INQUIRY:
3636 case REQUEST_SENSE:
3637 case TEST_UNIT_READY:
3638 case REPORT_LUNS:
3639 break; /* only allowable wlun commands */
3640 default:
3641 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
3642 printk(KERN_INFO "scsi_debug: Opcode: 0x%x "
3643 "not supported for wlun\n", *cmd);
3644 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3645 INVALID_OPCODE, 0);
3646 errsts = check_condition_result;
3647 return schedule_resp(SCpnt, devip, done, errsts,
3648 0);
3649 }
3650 }
3651
3652 switch (*cmd) {
3653 case INQUIRY: /* mandatory, ignore unit attention */
3654 delay_override = 1;
3655 errsts = resp_inquiry(SCpnt, target, devip);
3656 break;
3657 case REQUEST_SENSE: /* mandatory, ignore unit attention */
3658 delay_override = 1;
3659 errsts = resp_requests(SCpnt, devip);
3660 break;
3661 case REZERO_UNIT: /* actually this is REWIND for SSC */
3662 case START_STOP:
3663 errsts = resp_start_stop(SCpnt, devip);
3664 break;
3665 case ALLOW_MEDIUM_REMOVAL:
3666 errsts = check_readiness(SCpnt, 1, devip);
3667 if (errsts)
3668 break;
3669 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
3670 printk(KERN_INFO "scsi_debug: Medium removal %s\n",
3671 cmd[4] ? "inhibited" : "enabled");
3672 break;
3673 case SEND_DIAGNOSTIC: /* mandatory */
3674 errsts = check_readiness(SCpnt, 1, devip);
3675 break;
3676 case TEST_UNIT_READY: /* mandatory */
3677 delay_override = 1;
3678 errsts = check_readiness(SCpnt, 0, devip);
3679 break;
3680 case RESERVE:
3681 errsts = check_readiness(SCpnt, 1, devip);
3682 break;
3683 case RESERVE_10:
3684 errsts = check_readiness(SCpnt, 1, devip);
3685 break;
3686 case RELEASE:
3687 errsts = check_readiness(SCpnt, 1, devip);
3688 break;
3689 case RELEASE_10:
3690 errsts = check_readiness(SCpnt, 1, devip);
3691 break;
3692 case READ_CAPACITY:
3693 errsts = resp_readcap(SCpnt, devip);
3694 break;
3695 case SERVICE_ACTION_IN:
44d92694
MP		 3696 if (cmd[1] == SAI_READ_CAPACITY_16)
3697 errsts = resp_readcap16(SCpnt, devip);
3698 else if (cmd[1] == SAI_GET_LBA_STATUS) {
3699
5b94e232 3700 if (scsi_debug_lbp() == 0) {
44d92694
MP		 3701 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3702 INVALID_COMMAND_OPCODE, 0);
3703 errsts = check_condition_result;
3704 } else
3705 errsts = resp_get_lba_status(SCpnt, devip);
3706 } else {
639db475
FT		 3707 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3708 INVALID_OPCODE, 0);
3709 errsts = check_condition_result;
639db475 3710 }
639db475
FT		 3711 break;
3712 case MAINTENANCE_IN:
3713 if (MI_REPORT_TARGET_PGS != cmd[1]) {
3714 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3715 INVALID_OPCODE, 0);
3716 errsts = check_condition_result;
3717 break;
3718 }
3719 errsts = resp_report_tgtpgs(SCpnt, devip);
3720 break;
3721 case READ_16:
3722 case READ_12:
3723 case READ_10:
395cef03
MP		 3724 /* READ{10,12,16} and DIF Type 2 are natural enemies */
3725 if (scsi_debug_dif == SD_DIF_TYPE2_PROTECTION &&
3726 cmd[1] & 0xe0) {
3727 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3728 INVALID_COMMAND_OPCODE, 0);
3729 errsts = check_condition_result;
3730 break;
3731 }
3732
3733 if ((scsi_debug_dif == SD_DIF_TYPE1_PROTECTION ||
3734 scsi_debug_dif == SD_DIF_TYPE3_PROTECTION) &&
3735 (cmd[1] & 0xe0) == 0)
3736 printk(KERN_ERR "Unprotected RD/WR to DIF device\n");
3737
3738 /* fall through */
639db475 3739 case READ_6:
395cef03 3740read:
639db475
FT		 3741 errsts = check_readiness(SCpnt, 0, devip);
3742 if (errsts)
3743 break;
3744 if (scsi_debug_fake_rw)
3745 break;
395cef03
MP		 3746 get_data_transfer_info(cmd, &lba, &num, &ei_lba);
3747 errsts = resp_read(SCpnt, lba, num, devip, ei_lba);
639db475
FT		 3748 if (inj_recovered && (0 == errsts)) {
3749 mk_sense_buffer(devip, RECOVERED_ERROR,
3750 THRESHOLD_EXCEEDED, 0);
3751 errsts = check_condition_result;
3752 } else if (inj_transport && (0 == errsts)) {
3753 mk_sense_buffer(devip, ABORTED_COMMAND,
3754 TRANSPORT_PROBLEM, ACK_NAK_TO);
3755 errsts = check_condition_result;
c6a44287
MP		 3756 } else if (inj_dif && (0 == errsts)) {
3757 mk_sense_buffer(devip, ABORTED_COMMAND, 0x10, 1);
3758 errsts = illegal_condition_result;
3759 } else if (inj_dix && (0 == errsts)) {
3760 mk_sense_buffer(devip, ILLEGAL_REQUEST, 0x10, 1);
3761 errsts = illegal_condition_result;
639db475
FT		 3762 }
3763 break;
3764 case REPORT_LUNS: /* mandatory, ignore unit attention */
3765 delay_override = 1;
3766 errsts = resp_report_luns(SCpnt, devip);
3767 break;
3768 case VERIFY: /* 10 byte SBC-2 command */
3769 errsts = check_readiness(SCpnt, 0, devip);
3770 break;
3771 case WRITE_16:
3772 case WRITE_12:
3773 case WRITE_10:
395cef03
MP		 3774 /* WRITE{10,12,16} and DIF Type 2 are natural enemies */
3775 if (scsi_debug_dif == SD_DIF_TYPE2_PROTECTION &&
3776 cmd[1] & 0xe0) {
3777 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3778 INVALID_COMMAND_OPCODE, 0);
3779 errsts = check_condition_result;
3780 break;
3781 }
3782
3783 if ((scsi_debug_dif == SD_DIF_TYPE1_PROTECTION ||
3784 scsi_debug_dif == SD_DIF_TYPE3_PROTECTION) &&
3785 (cmd[1] & 0xe0) == 0)
3786 printk(KERN_ERR "Unprotected RD/WR to DIF device\n");
3787
3788 /* fall through */
639db475 3789 case WRITE_6:
395cef03 3790write:
639db475
FT		 3791 errsts = check_readiness(SCpnt, 0, devip);
3792 if (errsts)
3793 break;
3794 if (scsi_debug_fake_rw)
3795 break;
395cef03
MP		 3796 get_data_transfer_info(cmd, &lba, &num, &ei_lba);
3797 errsts = resp_write(SCpnt, lba, num, devip, ei_lba);
639db475
FT		 3798 if (inj_recovered && (0 == errsts)) {
3799 mk_sense_buffer(devip, RECOVERED_ERROR,
3800 THRESHOLD_EXCEEDED, 0);
3801 errsts = check_condition_result;
c6a44287
MP		 3802 } else if (inj_dif && (0 == errsts)) {
3803 mk_sense_buffer(devip, ABORTED_COMMAND, 0x10, 1);
3804 errsts = illegal_condition_result;
3805 } else if (inj_dix && (0 == errsts)) {
3806 mk_sense_buffer(devip, ILLEGAL_REQUEST, 0x10, 1);
3807 errsts = illegal_condition_result;
639db475
FT		 3808 }
3809 break;
44d92694 3810 case WRITE_SAME_16:
5b94e232 3811 case WRITE_SAME:
6014759c 3812 if (cmd[1] & 0x8) {
5b94e232
MP		 3813 if ((*cmd == WRITE_SAME_16 && scsi_debug_lbpws == 0) ||
3814 (*cmd == WRITE_SAME && scsi_debug_lbpws10 == 0)) {
6014759c
MP		 3815 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3816 INVALID_FIELD_IN_CDB, 0);
3817 errsts = check_condition_result;
3818 } else
3819 unmap = 1;
3820 }
3821 if (errsts)
3822 break;
44d92694
MP		 3823 errsts = check_readiness(SCpnt, 0, devip);
3824 if (errsts)
3825 break;
3826 get_data_transfer_info(cmd, &lba, &num, &ei_lba);
3827 errsts = resp_write_same(SCpnt, lba, num, devip, ei_lba, unmap);
3828 break;
3829 case UNMAP:
3830 errsts = check_readiness(SCpnt, 0, devip);
3831 if (errsts)
3832 break;
3833
5b94e232 3834 if (scsi_debug_unmap_max_desc == 0 || scsi_debug_lbpu == 0) {
44d92694
MP		 3835 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3836 INVALID_COMMAND_OPCODE, 0);
3837 errsts = check_condition_result;
3838 } else
3839 errsts = resp_unmap(SCpnt, devip);
3840 break;
639db475
FT		 3841 case MODE_SENSE:
3842 case MODE_SENSE_10:
3843 errsts = resp_mode_sense(SCpnt, target, devip);
3844 break;
3845 case MODE_SELECT:
3846 errsts = resp_mode_select(SCpnt, 1, devip);
3847 break;
3848 case MODE_SELECT_10:
3849 errsts = resp_mode_select(SCpnt, 0, devip);
3850 break;
3851 case LOG_SENSE:
3852 errsts = resp_log_sense(SCpnt, devip);
3853 break;
3854 case SYNCHRONIZE_CACHE:
3855 delay_override = 1;
3856 errsts = check_readiness(SCpnt, 0, devip);
3857 break;
3858 case WRITE_BUFFER:
3859 errsts = check_readiness(SCpnt, 1, devip);
3860 break;
3861 case XDWRITEREAD_10:
3862 if (!scsi_bidi_cmnd(SCpnt)) {
3863 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3864 INVALID_FIELD_IN_CDB, 0);
3865 errsts = check_condition_result;
3866 break;
3867 }
3868
3869 errsts = check_readiness(SCpnt, 0, devip);
3870 if (errsts)
3871 break;
3872 if (scsi_debug_fake_rw)
3873 break;
395cef03
MP		 3874 get_data_transfer_info(cmd, &lba, &num, &ei_lba);
3875 errsts = resp_read(SCpnt, lba, num, devip, ei_lba);
639db475
FT		 3876 if (errsts)
3877 break;
395cef03 3878 errsts = resp_write(SCpnt, lba, num, devip, ei_lba);
639db475
FT		 3879 if (errsts)
3880 break;
3881 errsts = resp_xdwriteread(SCpnt, lba, num, devip);
3882 break;
395cef03
MP		 3883 case VARIABLE_LENGTH_CMD:
3884 if (scsi_debug_dif == SD_DIF_TYPE2_PROTECTION) {
3885
3886 if ((cmd[10] & 0xe0) == 0)
3887 printk(KERN_ERR
3888 "Unprotected RD/WR to DIF device\n");
3889
3890 if (cmd[9] == READ_32) {
3891 BUG_ON(SCpnt->cmd_len < 32);
3892 goto read;
3893 }
3894
3895 if (cmd[9] == WRITE_32) {
3896 BUG_ON(SCpnt->cmd_len < 32);
3897 goto write;
3898 }
3899 }
3900
3901 mk_sense_buffer(devip, ILLEGAL_REQUEST,
3902 INVALID_FIELD_IN_CDB, 0);
3903 errsts = check_condition_result;
3904 break;
3905
639db475
FT		 3906 default:
3907 if (SCSI_DEBUG_OPT_NOISE & scsi_debug_opts)
3908 printk(KERN_INFO "scsi_debug: Opcode: 0x%x not "
3909 "supported\n", *cmd);
3910 errsts = check_readiness(SCpnt, 1, devip);
3911 if (errsts)
3912 break; /* Unit attention takes precedence */
3913 mk_sense_buffer(devip, ILLEGAL_REQUEST, INVALID_OPCODE, 0);
3914 errsts = check_condition_result;
3915 break;
3916 }
3917 return schedule_resp(SCpnt, devip, done, errsts,
3918 (delay_override ? 0 : scsi_debug_delay));
3919}
3920
f281233d
JG		 3921static DEF_SCSI_QCMD(scsi_debug_queuecommand)
3922
9e603ca0 3923static struct scsi_host_template sdebug_driver_template = {
c8ed555a
AV		 3924 .show_info = scsi_debug_show_info,
3925 .write_info = scsi_debug_write_info,
9e603ca0
FT		 3926 .proc_name = sdebug_proc_name,
3927 .name = "SCSI DEBUG",
3928 .info = scsi_debug_info,
3929 .slave_alloc = scsi_debug_slave_alloc,
3930 .slave_configure = scsi_debug_slave_configure,
3931 .slave_destroy = scsi_debug_slave_destroy,
3932 .ioctl = scsi_debug_ioctl,
3933 .queuecommand = scsi_debug_queuecommand,
3934 .eh_abort_handler = scsi_debug_abort,
3935 .eh_bus_reset_handler = scsi_debug_bus_reset,
3936 .eh_device_reset_handler = scsi_debug_device_reset,
3937 .eh_host_reset_handler = scsi_debug_host_reset,
3938 .bios_param = scsi_debug_biosparam,
3939 .can_queue = SCSI_DEBUG_CANQUEUE,
3940 .this_id = 7,
3941 .sg_tablesize = 256,
3942 .cmd_per_lun = 16,
3943 .max_sectors = 0xffff,
3944 .use_clustering = DISABLE_CLUSTERING,
3945 .module = THIS_MODULE,
3946};
3947
1da177e4
LT		 3948static int sdebug_driver_probe(struct device * dev)
3949{
3950 int error = 0;
3951 struct sdebug_host_info *sdbg_host;
3952 struct Scsi_Host *hpnt;
c6a44287 3953 int host_prot;
1da177e4
LT		 3954
3955 sdbg_host = to_sdebug_host(dev);
3956
78d4e5a0 3957 sdebug_driver_template.can_queue = scsi_debug_max_queue;
0759c666
AM		 3958 if (scsi_debug_clustering)
3959 sdebug_driver_template.use_clustering = ENABLE_CLUSTERING;
78d4e5a0
DG		 3960 hpnt = scsi_host_alloc(&sdebug_driver_template, sizeof(sdbg_host));
3961 if (NULL == hpnt) {
3962 printk(KERN_ERR "%s: scsi_register failed\n", __func__);
3963 error = -ENODEV;
1da177e4 3964 return error;
78d4e5a0 3965 }
1da177e4
LT		 3966
3967 sdbg_host->shost = hpnt;
3968 *((struct sdebug_host_info **)hpnt->hostdata) = sdbg_host;
3969 if ((hpnt->this_id >= 0) && (scsi_debug_num_tgts > hpnt->this_id))
3970 hpnt->max_id = scsi_debug_num_tgts + 1;
3971 else
3972 hpnt->max_id = scsi_debug_num_tgts;
c65b1445 3973 hpnt->max_lun = SAM2_WLUN_REPORT_LUNS; /* = scsi_debug_max_luns; */
1da177e4 3974
c6a44287
MP		 3975 host_prot = 0;
3976
3977 switch (scsi_debug_dif) {
3978
3979 case SD_DIF_TYPE1_PROTECTION:
3980 host_prot = SHOST_DIF_TYPE1_PROTECTION;
3981 if (scsi_debug_dix)
3982 host_prot |= SHOST_DIX_TYPE1_PROTECTION;
3983 break;
3984
3985 case SD_DIF_TYPE2_PROTECTION:
3986 host_prot = SHOST_DIF_TYPE2_PROTECTION;
3987 if (scsi_debug_dix)
3988 host_prot |= SHOST_DIX_TYPE2_PROTECTION;
3989 break;
3990
3991 case SD_DIF_TYPE3_PROTECTION:
3992 host_prot = SHOST_DIF_TYPE3_PROTECTION;
3993 if (scsi_debug_dix)
3994 host_prot |= SHOST_DIX_TYPE3_PROTECTION;
3995 break;
3996
3997 default:
3998 if (scsi_debug_dix)
3999 host_prot |= SHOST_DIX_TYPE0_PROTECTION;
4000 break;
4001 }
4002
4003 scsi_host_set_prot(hpnt, host_prot);
4004
4005 printk(KERN_INFO "scsi_debug: host protection%s%s%s%s%s%s%s\n",
4006 (host_prot & SHOST_DIF_TYPE1_PROTECTION) ? " DIF1" : "",
4007 (host_prot & SHOST_DIF_TYPE2_PROTECTION) ? " DIF2" : "",
4008 (host_prot & SHOST_DIF_TYPE3_PROTECTION) ? " DIF3" : "",
4009 (host_prot & SHOST_DIX_TYPE0_PROTECTION) ? " DIX0" : "",
4010 (host_prot & SHOST_DIX_TYPE1_PROTECTION) ? " DIX1" : "",
4011 (host_prot & SHOST_DIX_TYPE2_PROTECTION) ? " DIX2" : "",
4012 (host_prot & SHOST_DIX_TYPE3_PROTECTION) ? " DIX3" : "");
4013
4014 if (scsi_debug_guard == 1)
4015 scsi_host_set_guard(hpnt, SHOST_DIX_GUARD_IP);
4016 else
4017 scsi_host_set_guard(hpnt, SHOST_DIX_GUARD_CRC);
4018
1da177e4
LT		 4019 error = scsi_add_host(hpnt, &sdbg_host->dev);
4020 if (error) {
cadbd4a5 4021 printk(KERN_ERR "%s: scsi_add_host failed\n", __func__);
1da177e4
LT		 4022 error = -ENODEV;
4023 scsi_host_put(hpnt);
4024 } else
4025 scsi_scan_host(hpnt);
4026
4027
4028 return error;
4029}
4030
4031static int sdebug_driver_remove(struct device * dev)
4032{
1da177e4 4033 struct sdebug_host_info *sdbg_host;
8b40228f 4034 struct sdebug_dev_info *sdbg_devinfo, *tmp;
1da177e4
LT		 4035
4036 sdbg_host = to_sdebug_host(dev);
4037
4038 if (!sdbg_host) {
4039 printk(KERN_ERR "%s: Unable to locate host info\n",
cadbd4a5 4040 __func__);
1da177e4
LT		 4041 return -ENODEV;
4042 }
4043
4044 scsi_remove_host(sdbg_host->shost);
4045
8b40228f
FT		 4046 list_for_each_entry_safe(sdbg_devinfo, tmp, &sdbg_host->dev_info_list,
4047 dev_list) {
1da177e4
LT		 4048 list_del(&sdbg_devinfo->dev_list);
4049 kfree(sdbg_devinfo);
4050 }
4051
4052 scsi_host_put(sdbg_host->shost);
4053 return 0;
4054}
4055
8dea0d02
FT		 4056static int pseudo_lld_bus_match(struct device *dev,
4057 struct device_driver *dev_driver)
1da177e4 4058{
8dea0d02 4059 return 1;
1da177e4 4060}
8dea0d02
FT		 4061
4062static struct bus_type pseudo_lld_bus = {
4063 .name = "pseudo",
4064 .match = pseudo_lld_bus_match,
4065 .probe = sdebug_driver_probe,
4066 .remove = sdebug_driver_remove,
82069379 4067 .drv_groups = sdebug_drv_groups,
8dea0d02 4068};
ubuntu-bionic-kernel mirror