1#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
2
3#include <linux/slab.h>
4#include <linux/module.h>
5#include <linux/mutex.h>
6
7#include <scsi/scsi.h>
8#include <scsi/scsi_cmnd.h>
9#include <scsi/scsi_devinfo.h>
10#include <scsi/scsi_device.h>
11#include <scsi/scsi_eh.h>
12
13#include "usb.h"
14#include "scsiglue.h"
15#include "transport.h"
16
17
18
19
20
21static const char *host_info(struct Scsi_Host *host)
22{
23
24 return "SCSI emulation for USB Mass Storage devices";
25}
26
27
28
29
30static int slave_alloc(struct scsi_device *sdev)
31{
32 struct us_data *us = host_to_us(sdev->host);
33
34
35 sdev->inquiry_len = 36;
36
37 blk_queue_update_dma_alignment(sdev->request_queue, (512 - 1));
38
39 if (us->subclass == USB_SC_UFI)
40 sdev->sdev_target->pdt_1f_for_no_lun = 1;
41
42 return 0;
43}
44
45
46
47
48static int slave_configure(struct scsi_device *sdev)
49{
50 struct us_data *us = host_to_us(sdev->host);
51
52
53 if (us->fflags & (US_FL_MAX_SECTORS_64 | US_FL_MAX_SECTORS_MIN)) {
54 unsigned int max_sectors = 64;
55
56 if (us->fflags & US_FL_MAX_SECTORS_MIN)
57 max_sectors = PAGE_CACHE_SIZE >> 9;
58 if (queue_max_sectors(sdev->request_queue) > max_sectors)
59 blk_queue_max_hw_sectors(sdev->request_queue,
60 max_sectors);
61 }
62
63 if (sdev->type == TYPE_DISK) {
64 if (us->subclass != USB_SC_SCSI &&
65 us->subclass != USB_SC_CYP_ATACB)
66 sdev->use_10_for_ms = 1;
67 sdev->use_192_bytes_for_3f = 1;
68 if (us->fflags & US_FL_NO_WP_DETECT)
69 sdev->skip_ms_page_3f = 1;
70 sdev->skip_ms_page_8 = 1;
71 if (us->fflags & US_FL_FIX_CAPACITY)
72 sdev->fix_capacity = 1;
73 if (us->fflags & US_FL_CAPACITY_HEURISTICS)
74 sdev->guess_capacity = 1;
75 if (sdev->scsi_level > SCSI_2)
76 sdev->sdev_target->scsi_level = sdev->scsi_level = SCSI_2;
77 sdev->retry_hwerror = 1;
78 sdev->allow_restart = 1;
79 sdev->last_sector_bug = 1;
80 } else {
81 sdev->use_10_for_ms = 1;
82 }
83
84 if ((us->protocol == USB_PR_CB || us->protocol == USB_PR_CBI) &&
85 sdev->scsi_level == SCSI_UNKNOWN)
86 us->max_lun = 0;
87
88 if (us->fflags & US_FL_NOT_LOCKABLE)
89 sdev->lockable = 0;
90
91 return 0;
92}
93
94
95
96
97
98static int queuecommand_lck(struct scsi_cmnd *srb,
99 void (*done)(struct scsi_cmnd *))
100{
101 struct us_data *us = host_to_us(srb->device->host);
102
103
104
105
106 if (us->srb != NULL) {
107
108
109 return SCSI_MLQUEUE_HOST_BUSY;
110 }
111
112
113 if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
114 pr_info("Fail command during disconnect\n");
115 srb->result = DID_NO_CONNECT << 16;
116 done(srb);
117 return 0;
118 }
119
120
121 srb->scsi_done = done;
122 us->srb = srb;
123 complete(&us->cmnd_ready);
124
125 return 0;
126}
127
128static DEF_SCSI_QCMD(queuecommand)
129
130
131
132
133
134
135
136
137
138static int command_abort(struct scsi_cmnd *srb)
139{
140 struct us_data *us = host_to_us(srb->device->host);
141
142
143
144 scsi_lock(us_to_host(us));
145 if (us->srb != srb) {
146 scsi_unlock(us_to_host(us));
147 printk("-- nothing to abort\n");
148 return FAILED;
149 }
150
151 set_bit(US_FLIDX_TIMED_OUT, &us->dflags);
152 if (!test_bit(US_FLIDX_RESETTING, &us->dflags)) {
153 set_bit(US_FLIDX_ABORTING, &us->dflags);
154 usb_stor_stop_transport(us);
155 }
156 scsi_unlock(us_to_host(us));
157
158
159 wait_for_completion(&us->notify);
160 return SUCCESS;
161}
162
163
164
165
166
167
168
169static int device_reset(struct scsi_cmnd *srb)
170{
171 struct us_data *us = host_to_us(srb->device->host);
172 int result;
173
174
175
176
177 mutex_lock(&(us->dev_mutex));
178 result = us->transport_reset(us);
179 mutex_unlock(&us->dev_mutex);
180
181 return result < 0 ? FAILED : SUCCESS;
182}
183
184
185
186
187static int bus_reset(struct scsi_cmnd *srb)
188{
189 struct us_data *us = host_to_us(srb->device->host);
190 int result;
191
192
193 result = usb_stor_port_reset(us);
194 return result < 0 ? FAILED : SUCCESS;
195}
196
197
198
199
200void usb_stor_report_device_reset(struct us_data *us)
201{
202 int i;
203 struct Scsi_Host *host = us_to_host(us);
204
205
206 scsi_report_device_reset(host, 0, 0);
207 if (us->fflags & US_FL_SCM_MULT_TARG) {
208 for (i = 1; i < host->max_id; ++i)
209 scsi_report_device_reset(host, 0, i);
210 }
211}
212
213
214
215
216void usb_stor_report_bus_reset(struct us_data *us)
217{
218 struct Scsi_Host *host = us_to_host(us);
219
220
221 scsi_lock(host);
222 scsi_report_bus_reset(host, 0);
223 scsi_unlock(host);
224}
225
226
227
228
229
230
231#undef SPRINTF
232#define SPRINTF(args...) \
233 do { \
234 if (pos < buffer+length) \
235 pos += sprintf(pos, ## args); \
236 } while (0)
237
238
239
240
241static int proc_info(struct Scsi_Host *host, char *buffer, char **start,
242 off_t offset, int length, int inout)
243{
244 struct us_data *us = host_to_us(host);
245 char *pos = buffer;
246 const char *string;
247
248
249 if (inout)
250 return length;
251
252
253 SPRINTF(" Host scsi%d: usb-storage\n", host->host_no);
254
255
256 if (us->pusb_dev->manufacturer)
257 string = us->pusb_dev->manufacturer;
258 else if (us->unusual_dev->vendorName)
259 string = us->unusual_dev->vendorName;
260 else
261 string = "Unknown";
262 SPRINTF(" Vendor: %s\n", string);
263 if (us->pusb_dev->product)
264 string = us->pusb_dev->product;
265 else if (us->unusual_dev->productName)
266 string = us->unusual_dev->productName;
267 else
268 string = "Unknown";
269 SPRINTF(" Product: %s\n", string);
270 if (us->pusb_dev->serial)
271 string = us->pusb_dev->serial;
272 else
273 string = "None";
274 SPRINTF("Serial Number: %s\n", string);
275
276
277 SPRINTF(" Protocol: %s\n", us->protocol_name);
278 SPRINTF(" Transport: %s\n", us->transport_name);
279
280
281 if (pos < buffer + length) {
282 pos += sprintf(pos, " Quirks:");
283
284#define US_FLAG(name, value) \
285 do { \
286 if (us->fflags & value) \
287 pos += sprintf(pos, " " #name); \
288 } while (0);
289US_DO_ALL_FLAGS
290#undef US_FLAG
291
292 *(pos++) = '\n';
293 }
294
295
296 *start = buffer + offset;
297
298 if ((pos - buffer) < offset)
299 return 0;
300 else if ((pos - buffer - offset) < length)
301 return pos - buffer - offset;
302 else
303 return length;
304}
305
306
307
308
309
310
311
312
313
314static ssize_t show_max_sectors(struct device *dev,
315 struct device_attribute *attr, char *buf)
316{
317 struct scsi_device *sdev = to_scsi_device(dev);
318
319
320 return sprintf(buf, "%u\n", queue_max_sectors(sdev->request_queue));
321}
322
323
324
325
326
327static ssize_t store_max_sectors(struct device *dev,
328 struct device_attribute *attr,
329 const char *buf, size_t count)
330{
331 struct scsi_device *sdev = to_scsi_device(dev);
332 unsigned short ms;
333
334
335 if (sscanf(buf, "%hu", &ms) > 0 && ms <= SCSI_DEFAULT_MAX_SECTORS) {
336 blk_queue_max_hw_sectors(sdev->request_queue, ms);
337 return strlen(buf);
338 }
339 return -EINVAL;
340}
341
342static DEVICE_ATTR(max_sectors, S_IRUGO | S_IWUSR, show_max_sectors, store_max_sectors);
343static struct device_attribute *sysfs_device_attr_list[] = {&dev_attr_max_sectors, NULL, };
344
345
346
347
348
349
350struct scsi_host_template usb_stor_host_template = {
351
352 .name = "eucr-storage",
353 .proc_name = "eucr-storage",
354 .proc_info = proc_info,
355 .info = host_info,
356
357
358 .queuecommand = queuecommand,
359
360
361 .eh_abort_handler = command_abort,
362 .eh_device_reset_handler = device_reset,
363 .eh_bus_reset_handler = bus_reset,
364
365
366 .can_queue = 1,
367 .cmd_per_lun = 1,
368
369
370 .this_id = -1,
371
372 .slave_alloc = slave_alloc,
373 .slave_configure = slave_configure,
374
375
376 .sg_tablesize = SG_ALL,
377
378
379 .max_sectors = 240,
380
381
382
383
384
385 .use_clustering = 1,
386
387
388 .emulated = 1,
389
390
391 .skip_settle_delay = 1,
392
393
394 .sdev_attrs = sysfs_device_attr_list,
395
396
397 .module = THIS_MODULE
398};
399
400
401unsigned char usb_stor_sense_invalidCDB[18] = {
402 [0] = 0x70,
403 [2] = ILLEGAL_REQUEST,
404 [7] = 0x0a,
405 [12] = 0x24
406};
407
408
409
410
411
412
413
414
415unsigned int usb_stor_access_xfer_buf(struct us_data *us, unsigned char *buffer,
416 unsigned int buflen, struct scsi_cmnd *srb, struct scatterlist **sgptr,
417 unsigned int *offset, enum xfer_buf_dir dir)
418{
419 unsigned int cnt;
420
421
422 struct scatterlist *sg = *sgptr;
423
424 if (!sg)
425 sg = scsi_sglist(srb);
426
427 cnt = 0;
428 while (cnt < buflen && sg) {
429 struct page *page = sg_page(sg) +
430 ((sg->offset + *offset) >> PAGE_SHIFT);
431 unsigned int poff = (sg->offset + *offset) & (PAGE_SIZE-1);
432 unsigned int sglen = sg->length - *offset;
433
434 if (sglen > buflen - cnt) {
435
436 sglen = buflen - cnt;
437 *offset += sglen;
438 } else {
439
440 *offset = 0;
441 sg = sg_next(sg);
442 }
443
444 while (sglen > 0) {
445 unsigned int plen = min(sglen,
446 (unsigned int)PAGE_SIZE - poff);
447 unsigned char *ptr = kmap(page);
448
449 if (dir == TO_XFER_BUF)
450 memcpy(ptr + poff, buffer + cnt, plen);
451 else
452 memcpy(buffer + cnt, ptr + poff, plen);
453 kunmap(page);
454
455
456 poff = 0;
457 ++page;
458 cnt += plen;
459 sglen -= plen;
460 }
461 }
462 *sgptr = sg;
463
464
465 return cnt;
466}
467
468
469
470
471
472
473
474
475void usb_stor_set_xfer_buf(struct us_data *us, unsigned char *buffer,
476 unsigned int buflen, struct scsi_cmnd *srb, unsigned int dir)
477{
478 unsigned int offset = 0;
479 struct scatterlist *sg = NULL;
480
481
482
483 buflen = min(buflen, scsi_bufflen(srb));
484 buflen = usb_stor_access_xfer_buf(us, buffer, buflen, srb,
485 &sg, &offset, dir);
486 if (buflen < scsi_bufflen(srb))
487 scsi_set_resid(srb, scsi_bufflen(srb) - buflen);
488}
489