1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49#ifdef CONFIG_USB_STORAGE_DEBUG
50#define DEBUG
51#endif
52
53#include <linux/sched.h>
54#include <linux/errno.h>
55#include <linux/module.h>
56#include <linux/slab.h>
57#include <linux/kthread.h>
58#include <linux/mutex.h>
59#include <linux/utsname.h>
60
61#include <scsi/scsi.h>
62#include <scsi/scsi_cmnd.h>
63#include <scsi/scsi_device.h>
64
65#include "usb.h"
66#include "scsiglue.h"
67#include "transport.h"
68#include "protocol.h"
69#include "debug.h"
70#include "initializers.h"
71
72#include "sierra_ms.h"
73#include "option_ms.h"
74
75#if IS_ENABLED(CONFIG_USB_UAS)
76#include "uas-detect.h"
77#endif
78
79#define DRV_NAME "usb-storage"
80
81
82MODULE_AUTHOR("Matthew Dharm <mdharm-usb@one-eyed-alien.net>");
83MODULE_DESCRIPTION("USB Mass Storage driver for Linux");
84MODULE_LICENSE("GPL");
85
86static unsigned int delay_use = 1;
87module_param(delay_use, uint, S_IRUGO | S_IWUSR);
88MODULE_PARM_DESC(delay_use, "seconds to delay before using a new device");
89
90static char quirks[128];
91module_param_string(quirks, quirks, sizeof(quirks), S_IRUGO | S_IWUSR);
92MODULE_PARM_DESC(quirks, "supplemental list of device IDs and their quirks");
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110#define UNUSUAL_DEV(idVendor, idProduct, bcdDeviceMin, bcdDeviceMax, \
111 vendor_name, product_name, use_protocol, use_transport, \
112 init_function, Flags) \
113{ \
114 .vendorName = vendor_name, \
115 .productName = product_name, \
116 .useProtocol = use_protocol, \
117 .useTransport = use_transport, \
118 .initFunction = init_function, \
119}
120
121#define COMPLIANT_DEV UNUSUAL_DEV
122
123#define USUAL_DEV(use_protocol, use_transport) \
124{ \
125 .useProtocol = use_protocol, \
126 .useTransport = use_transport, \
127}
128
129#define UNUSUAL_VENDOR_INTF(idVendor, cl, sc, pr, \
130 vendor_name, product_name, use_protocol, use_transport, \
131 init_function, Flags) \
132{ \
133 .vendorName = vendor_name, \
134 .productName = product_name, \
135 .useProtocol = use_protocol, \
136 .useTransport = use_transport, \
137 .initFunction = init_function, \
138}
139
140static struct us_unusual_dev us_unusual_dev_list[] = {
141# include "unusual_devs.h"
142 { }
143};
144
145static struct us_unusual_dev for_dynamic_ids =
146 USUAL_DEV(USB_SC_SCSI, USB_PR_BULK);
147
148#undef UNUSUAL_DEV
149#undef COMPLIANT_DEV
150#undef USUAL_DEV
151#undef UNUSUAL_VENDOR_INTF
152
153#ifdef CONFIG_LOCKDEP
154
155static struct lock_class_key us_interface_key[USB_MAXINTERFACES];
156
157static void us_set_lock_class(struct mutex *mutex,
158 struct usb_interface *intf)
159{
160 struct usb_device *udev = interface_to_usbdev(intf);
161 struct usb_host_config *config = udev->actconfig;
162 int i;
163
164 for (i = 0; i < config->desc.bNumInterfaces; i++) {
165 if (config->interface[i] == intf)
166 break;
167 }
168
169 BUG_ON(i == config->desc.bNumInterfaces);
170
171 lockdep_set_class(mutex, &us_interface_key[i]);
172}
173
174#else
175
176static void us_set_lock_class(struct mutex *mutex,
177 struct usb_interface *intf)
178{
179}
180
181#endif
182
183#ifdef CONFIG_PM
184
185int usb_stor_suspend(struct usb_interface *iface, pm_message_t message)
186{
187 struct us_data *us = usb_get_intfdata(iface);
188
189
190 mutex_lock(&us->dev_mutex);
191
192 if (us->suspend_resume_hook)
193 (us->suspend_resume_hook)(us, US_SUSPEND);
194
195
196
197
198
199
200 mutex_unlock(&us->dev_mutex);
201 return 0;
202}
203EXPORT_SYMBOL_GPL(usb_stor_suspend);
204
205int usb_stor_resume(struct usb_interface *iface)
206{
207 struct us_data *us = usb_get_intfdata(iface);
208
209 mutex_lock(&us->dev_mutex);
210
211 if (us->suspend_resume_hook)
212 (us->suspend_resume_hook)(us, US_RESUME);
213
214 mutex_unlock(&us->dev_mutex);
215 return 0;
216}
217EXPORT_SYMBOL_GPL(usb_stor_resume);
218
219int usb_stor_reset_resume(struct usb_interface *iface)
220{
221 struct us_data *us = usb_get_intfdata(iface);
222
223
224 usb_stor_report_bus_reset(us);
225
226
227
228
229
230 return 0;
231}
232EXPORT_SYMBOL_GPL(usb_stor_reset_resume);
233
234#endif
235
236
237
238
239
240
241int usb_stor_pre_reset(struct usb_interface *iface)
242{
243 struct us_data *us = usb_get_intfdata(iface);
244
245
246 mutex_lock(&us->dev_mutex);
247 return 0;
248}
249EXPORT_SYMBOL_GPL(usb_stor_pre_reset);
250
251int usb_stor_post_reset(struct usb_interface *iface)
252{
253 struct us_data *us = usb_get_intfdata(iface);
254
255
256 usb_stor_report_bus_reset(us);
257
258
259
260
261
262
263 mutex_unlock(&us->dev_mutex);
264 return 0;
265}
266EXPORT_SYMBOL_GPL(usb_stor_post_reset);
267
268
269
270
271
272
273
274
275
276
277void fill_inquiry_response(struct us_data *us, unsigned char *data,
278 unsigned int data_len)
279{
280 if (data_len < 36)
281 return;
282
283 memset(data+8, ' ', 28);
284 if (data[0]&0x20) {
285
286
287
288
289
290
291
292
293
294
295 } else {
296 u16 bcdDevice = le16_to_cpu(us->pusb_dev->descriptor.bcdDevice);
297 int n;
298
299 n = strlen(us->unusual_dev->vendorName);
300 memcpy(data+8, us->unusual_dev->vendorName, min(8, n));
301 n = strlen(us->unusual_dev->productName);
302 memcpy(data+16, us->unusual_dev->productName, min(16, n));
303
304 data[32] = 0x30 + ((bcdDevice>>12) & 0x0F);
305 data[33] = 0x30 + ((bcdDevice>>8) & 0x0F);
306 data[34] = 0x30 + ((bcdDevice>>4) & 0x0F);
307 data[35] = 0x30 + ((bcdDevice) & 0x0F);
308 }
309
310 usb_stor_set_xfer_buf(data, data_len, us->srb);
311}
312EXPORT_SYMBOL_GPL(fill_inquiry_response);
313
314static int usb_stor_control_thread(void * __us)
315{
316 struct us_data *us = (struct us_data *)__us;
317 struct Scsi_Host *host = us_to_host(us);
318
319 for (;;) {
320 usb_stor_dbg(us, "*** thread sleeping\n");
321 if (wait_for_completion_interruptible(&us->cmnd_ready))
322 break;
323
324 usb_stor_dbg(us, "*** thread awakened\n");
325
326
327 mutex_lock(&(us->dev_mutex));
328
329
330 scsi_lock(host);
331
332
333 if (us->srb == NULL) {
334 scsi_unlock(host);
335 mutex_unlock(&us->dev_mutex);
336 usb_stor_dbg(us, "-- exiting\n");
337 break;
338 }
339
340
341 if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
342 us->srb->result = DID_ABORT << 16;
343 goto SkipForAbort;
344 }
345
346 scsi_unlock(host);
347
348
349
350
351
352 if (us->srb->sc_data_direction == DMA_BIDIRECTIONAL) {
353 usb_stor_dbg(us, "UNKNOWN data direction\n");
354 us->srb->result = DID_ERROR << 16;
355 }
356
357
358
359
360
361 else if (us->srb->device->id &&
362 !(us->fflags & US_FL_SCM_MULT_TARG)) {
363 usb_stor_dbg(us, "Bad target number (%d:%llu)\n",
364 us->srb->device->id,
365 us->srb->device->lun);
366 us->srb->result = DID_BAD_TARGET << 16;
367 }
368
369 else if (us->srb->device->lun > us->max_lun) {
370 usb_stor_dbg(us, "Bad LUN (%d:%llu)\n",
371 us->srb->device->id,
372 us->srb->device->lun);
373 us->srb->result = DID_BAD_TARGET << 16;
374 }
375
376
377
378
379
380 else if ((us->srb->cmnd[0] == INQUIRY) &&
381 (us->fflags & US_FL_FIX_INQUIRY)) {
382 unsigned char data_ptr[36] = {
383 0x00, 0x80, 0x02, 0x02,
384 0x1F, 0x00, 0x00, 0x00};
385
386 usb_stor_dbg(us, "Faking INQUIRY command\n");
387 fill_inquiry_response(us, data_ptr, 36);
388 us->srb->result = SAM_STAT_GOOD;
389 }
390
391
392 else {
393 US_DEBUG(usb_stor_show_command(us, us->srb));
394 us->proto_handler(us->srb, us);
395 usb_mark_last_busy(us->pusb_dev);
396 }
397
398
399 scsi_lock(host);
400
401
402 if (us->srb->result != DID_ABORT << 16) {
403 usb_stor_dbg(us, "scsi cmd done, result=0x%x\n",
404 us->srb->result);
405 us->srb->scsi_done(us->srb);
406 } else {
407SkipForAbort:
408 usb_stor_dbg(us, "scsi command aborted\n");
409 }
410
411
412
413
414
415
416
417
418 if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
419 complete(&(us->notify));
420
421
422 clear_bit(US_FLIDX_ABORTING, &us->dflags);
423 clear_bit(US_FLIDX_TIMED_OUT, &us->dflags);
424 }
425
426
427 us->srb = NULL;
428 scsi_unlock(host);
429
430
431 mutex_unlock(&us->dev_mutex);
432 }
433
434
435 for (;;) {
436 set_current_state(TASK_INTERRUPTIBLE);
437 if (kthread_should_stop())
438 break;
439 schedule();
440 }
441 __set_current_state(TASK_RUNNING);
442 return 0;
443}
444
445
446
447
448
449
450static int associate_dev(struct us_data *us, struct usb_interface *intf)
451{
452
453 us->pusb_dev = interface_to_usbdev(intf);
454 us->pusb_intf = intf;
455 us->ifnum = intf->cur_altsetting->desc.bInterfaceNumber;
456 usb_stor_dbg(us, "Vendor: 0x%04x, Product: 0x%04x, Revision: 0x%04x\n",
457 le16_to_cpu(us->pusb_dev->descriptor.idVendor),
458 le16_to_cpu(us->pusb_dev->descriptor.idProduct),
459 le16_to_cpu(us->pusb_dev->descriptor.bcdDevice));
460 usb_stor_dbg(us, "Interface Subclass: 0x%02x, Protocol: 0x%02x\n",
461 intf->cur_altsetting->desc.bInterfaceSubClass,
462 intf->cur_altsetting->desc.bInterfaceProtocol);
463
464
465 usb_set_intfdata(intf, us);
466
467
468 us->cr = kmalloc(sizeof(*us->cr), GFP_KERNEL);
469 if (!us->cr)
470 return -ENOMEM;
471
472 us->iobuf = usb_alloc_coherent(us->pusb_dev, US_IOBUF_SIZE,
473 GFP_KERNEL, &us->iobuf_dma);
474 if (!us->iobuf) {
475 usb_stor_dbg(us, "I/O buffer allocation failed\n");
476 return -ENOMEM;
477 }
478 return 0;
479}
480
481
482#define TOLOWER(x) ((x) | 0x20)
483
484
485void usb_stor_adjust_quirks(struct usb_device *udev, unsigned long *fflags)
486{
487 char *p;
488 u16 vid = le16_to_cpu(udev->descriptor.idVendor);
489 u16 pid = le16_to_cpu(udev->descriptor.idProduct);
490 unsigned f = 0;
491 unsigned int mask = (US_FL_SANE_SENSE | US_FL_BAD_SENSE |
492 US_FL_FIX_CAPACITY | US_FL_IGNORE_UAS |
493 US_FL_CAPACITY_HEURISTICS | US_FL_IGNORE_DEVICE |
494 US_FL_NOT_LOCKABLE | US_FL_MAX_SECTORS_64 |
495 US_FL_CAPACITY_OK | US_FL_IGNORE_RESIDUE |
496 US_FL_SINGLE_LUN | US_FL_NO_WP_DETECT |
497 US_FL_NO_READ_DISC_INFO | US_FL_NO_READ_CAPACITY_16 |
498 US_FL_INITIAL_READ10 | US_FL_WRITE_CACHE |
499 US_FL_NO_ATA_1X | US_FL_NO_REPORT_OPCODES |
500 US_FL_MAX_SECTORS_240 | US_FL_NO_REPORT_LUNS |
501 US_FL_ALWAYS_SYNC);
502
503 p = quirks;
504 while (*p) {
505
506 if (vid == simple_strtoul(p, &p, 16) &&
507 *p == ':' &&
508 pid == simple_strtoul(p+1, &p, 16) &&
509 *p == ':')
510 break;
511
512
513 while (*p) {
514 if (*p++ == ',')
515 break;
516 }
517 }
518 if (!*p)
519 return;
520
521
522 while (*++p && *p != ',') {
523 switch (TOLOWER(*p)) {
524 case 'a':
525 f |= US_FL_SANE_SENSE;
526 break;
527 case 'b':
528 f |= US_FL_BAD_SENSE;
529 break;
530 case 'c':
531 f |= US_FL_FIX_CAPACITY;
532 break;
533 case 'd':
534 f |= US_FL_NO_READ_DISC_INFO;
535 break;
536 case 'e':
537 f |= US_FL_NO_READ_CAPACITY_16;
538 break;
539 case 'f':
540 f |= US_FL_NO_REPORT_OPCODES;
541 break;
542 case 'g':
543 f |= US_FL_MAX_SECTORS_240;
544 break;
545 case 'h':
546 f |= US_FL_CAPACITY_HEURISTICS;
547 break;
548 case 'i':
549 f |= US_FL_IGNORE_DEVICE;
550 break;
551 case 'j':
552 f |= US_FL_NO_REPORT_LUNS;
553 break;
554 case 'l':
555 f |= US_FL_NOT_LOCKABLE;
556 break;
557 case 'm':
558 f |= US_FL_MAX_SECTORS_64;
559 break;
560 case 'n':
561 f |= US_FL_INITIAL_READ10;
562 break;
563 case 'o':
564 f |= US_FL_CAPACITY_OK;
565 break;
566 case 'p':
567 f |= US_FL_WRITE_CACHE;
568 break;
569 case 'r':
570 f |= US_FL_IGNORE_RESIDUE;
571 break;
572 case 's':
573 f |= US_FL_SINGLE_LUN;
574 break;
575 case 't':
576 f |= US_FL_NO_ATA_1X;
577 break;
578 case 'u':
579 f |= US_FL_IGNORE_UAS;
580 break;
581 case 'w':
582 f |= US_FL_NO_WP_DETECT;
583 break;
584 case 'y':
585 f |= US_FL_ALWAYS_SYNC;
586 break;
587
588 }
589 }
590 *fflags = (*fflags & ~mask) | f;
591}
592EXPORT_SYMBOL_GPL(usb_stor_adjust_quirks);
593
594
595static int get_device_info(struct us_data *us, const struct usb_device_id *id,
596 struct us_unusual_dev *unusual_dev)
597{
598 struct usb_device *dev = us->pusb_dev;
599 struct usb_interface_descriptor *idesc =
600 &us->pusb_intf->cur_altsetting->desc;
601 struct device *pdev = &us->pusb_intf->dev;
602
603
604 us->unusual_dev = unusual_dev;
605 us->subclass = (unusual_dev->useProtocol == USB_SC_DEVICE) ?
606 idesc->bInterfaceSubClass :
607 unusual_dev->useProtocol;
608 us->protocol = (unusual_dev->useTransport == USB_PR_DEVICE) ?
609 idesc->bInterfaceProtocol :
610 unusual_dev->useTransport;
611 us->fflags = id->driver_info;
612 usb_stor_adjust_quirks(us->pusb_dev, &us->fflags);
613
614 if (us->fflags & US_FL_IGNORE_DEVICE) {
615 dev_info(pdev, "device ignored\n");
616 return -ENODEV;
617 }
618
619
620
621
622
623 if (dev->speed != USB_SPEED_HIGH)
624 us->fflags &= ~US_FL_GO_SLOW;
625
626 if (us->fflags)
627 dev_info(pdev, "Quirks match for vid %04x pid %04x: %lx\n",
628 le16_to_cpu(dev->descriptor.idVendor),
629 le16_to_cpu(dev->descriptor.idProduct),
630 us->fflags);
631
632
633
634
635
636
637
638 if (id->idVendor || id->idProduct) {
639 static const char *msgs[3] = {
640 "an unneeded SubClass entry",
641 "an unneeded Protocol entry",
642 "unneeded SubClass and Protocol entries"};
643 struct usb_device_descriptor *ddesc = &dev->descriptor;
644 int msg = -1;
645
646 if (unusual_dev->useProtocol != USB_SC_DEVICE &&
647 us->subclass == idesc->bInterfaceSubClass)
648 msg += 1;
649 if (unusual_dev->useTransport != USB_PR_DEVICE &&
650 us->protocol == idesc->bInterfaceProtocol)
651 msg += 2;
652 if (msg >= 0 && !(us->fflags & US_FL_NEED_OVERRIDE))
653 dev_notice(pdev, "This device "
654 "(%04x,%04x,%04x S %02x P %02x)"
655 " has %s in unusual_devs.h (kernel"
656 " %s)\n"
657 " Please send a copy of this message to "
658 "<linux-usb@vger.kernel.org> and "
659 "<usb-storage@lists.one-eyed-alien.net>\n",
660 le16_to_cpu(ddesc->idVendor),
661 le16_to_cpu(ddesc->idProduct),
662 le16_to_cpu(ddesc->bcdDevice),
663 idesc->bInterfaceSubClass,
664 idesc->bInterfaceProtocol,
665 msgs[msg],
666 utsname()->release);
667 }
668
669 return 0;
670}
671
672
673static void get_transport(struct us_data *us)
674{
675 switch (us->protocol) {
676 case USB_PR_CB:
677 us->transport_name = "Control/Bulk";
678 us->transport = usb_stor_CB_transport;
679 us->transport_reset = usb_stor_CB_reset;
680 us->max_lun = 7;
681 break;
682
683 case USB_PR_CBI:
684 us->transport_name = "Control/Bulk/Interrupt";
685 us->transport = usb_stor_CB_transport;
686 us->transport_reset = usb_stor_CB_reset;
687 us->max_lun = 7;
688 break;
689
690 case USB_PR_BULK:
691 us->transport_name = "Bulk";
692 us->transport = usb_stor_Bulk_transport;
693 us->transport_reset = usb_stor_Bulk_reset;
694 break;
695 }
696}
697
698
699static void get_protocol(struct us_data *us)
700{
701 switch (us->subclass) {
702 case USB_SC_RBC:
703 us->protocol_name = "Reduced Block Commands (RBC)";
704 us->proto_handler = usb_stor_transparent_scsi_command;
705 break;
706
707 case USB_SC_8020:
708 us->protocol_name = "8020i";
709 us->proto_handler = usb_stor_pad12_command;
710 us->max_lun = 0;
711 break;
712
713 case USB_SC_QIC:
714 us->protocol_name = "QIC-157";
715 us->proto_handler = usb_stor_pad12_command;
716 us->max_lun = 0;
717 break;
718
719 case USB_SC_8070:
720 us->protocol_name = "8070i";
721 us->proto_handler = usb_stor_pad12_command;
722 us->max_lun = 0;
723 break;
724
725 case USB_SC_SCSI:
726 us->protocol_name = "Transparent SCSI";
727 us->proto_handler = usb_stor_transparent_scsi_command;
728 break;
729
730 case USB_SC_UFI:
731 us->protocol_name = "Uniform Floppy Interface (UFI)";
732 us->proto_handler = usb_stor_ufi_command;
733 break;
734 }
735}
736
737
738static int get_pipes(struct us_data *us)
739{
740 struct usb_host_interface *alt = us->pusb_intf->cur_altsetting;
741 struct usb_endpoint_descriptor *ep_in;
742 struct usb_endpoint_descriptor *ep_out;
743 struct usb_endpoint_descriptor *ep_int;
744 int res;
745
746
747
748
749
750
751
752 res = usb_find_common_endpoints(alt, &ep_in, &ep_out, NULL, NULL);
753 if (res) {
754 usb_stor_dbg(us, "bulk endpoints not found\n");
755 return res;
756 }
757
758 res = usb_find_int_in_endpoint(alt, &ep_int);
759 if (res && us->protocol == USB_PR_CBI) {
760 usb_stor_dbg(us, "interrupt endpoint not found\n");
761 return res;
762 }
763
764
765 us->send_ctrl_pipe = usb_sndctrlpipe(us->pusb_dev, 0);
766 us->recv_ctrl_pipe = usb_rcvctrlpipe(us->pusb_dev, 0);
767 us->send_bulk_pipe = usb_sndbulkpipe(us->pusb_dev,
768 usb_endpoint_num(ep_out));
769 us->recv_bulk_pipe = usb_rcvbulkpipe(us->pusb_dev,
770 usb_endpoint_num(ep_in));
771 if (ep_int) {
772 us->recv_intr_pipe = usb_rcvintpipe(us->pusb_dev,
773 usb_endpoint_num(ep_int));
774 us->ep_bInterval = ep_int->bInterval;
775 }
776 return 0;
777}
778
779
780static int usb_stor_acquire_resources(struct us_data *us)
781{
782 int p;
783 struct task_struct *th;
784
785 us->current_urb = usb_alloc_urb(0, GFP_KERNEL);
786 if (!us->current_urb)
787 return -ENOMEM;
788
789
790
791
792
793 if (us->unusual_dev->initFunction) {
794 p = us->unusual_dev->initFunction(us);
795 if (p)
796 return p;
797 }
798
799
800 th = kthread_run(usb_stor_control_thread, us, "usb-storage");
801 if (IS_ERR(th)) {
802 dev_warn(&us->pusb_intf->dev,
803 "Unable to start control thread\n");
804 return PTR_ERR(th);
805 }
806 us->ctl_thread = th;
807
808 return 0;
809}
810
811
812static void usb_stor_release_resources(struct us_data *us)
813{
814
815
816
817
818
819 usb_stor_dbg(us, "-- sending exit command to thread\n");
820 complete(&us->cmnd_ready);
821 if (us->ctl_thread)
822 kthread_stop(us->ctl_thread);
823
824
825 if (us->extra_destructor) {
826 usb_stor_dbg(us, "-- calling extra_destructor()\n");
827 us->extra_destructor(us->extra);
828 }
829
830
831 kfree(us->extra);
832 usb_free_urb(us->current_urb);
833}
834
835
836static void dissociate_dev(struct us_data *us)
837{
838
839 kfree(us->cr);
840 usb_free_coherent(us->pusb_dev, US_IOBUF_SIZE, us->iobuf, us->iobuf_dma);
841
842
843 usb_set_intfdata(us->pusb_intf, NULL);
844}
845
846
847
848
849
850static void quiesce_and_remove_host(struct us_data *us)
851{
852 struct Scsi_Host *host = us_to_host(us);
853
854
855 if (us->pusb_dev->state == USB_STATE_NOTATTACHED) {
856 set_bit(US_FLIDX_DISCONNECTING, &us->dflags);
857 wake_up(&us->delay_wait);
858 }
859
860
861
862
863
864 cancel_delayed_work_sync(&us->scan_dwork);
865
866
867 if (test_bit(US_FLIDX_SCAN_PENDING, &us->dflags))
868 usb_autopm_put_interface_no_suspend(us->pusb_intf);
869
870
871
872
873
874 scsi_remove_host(host);
875
876
877
878
879
880 scsi_lock(host);
881 set_bit(US_FLIDX_DISCONNECTING, &us->dflags);
882 scsi_unlock(host);
883 wake_up(&us->delay_wait);
884}
885
886
887static void release_everything(struct us_data *us)
888{
889 usb_stor_release_resources(us);
890 dissociate_dev(us);
891
892
893
894
895
896 scsi_host_put(us_to_host(us));
897}
898
899
900static void usb_stor_scan_dwork(struct work_struct *work)
901{
902 struct us_data *us = container_of(work, struct us_data,
903 scan_dwork.work);
904 struct device *dev = &us->pusb_intf->dev;
905
906 dev_dbg(dev, "starting scan\n");
907
908
909 if (us->protocol == USB_PR_BULK &&
910 !(us->fflags & US_FL_SINGLE_LUN) &&
911 !(us->fflags & US_FL_SCM_MULT_TARG)) {
912 mutex_lock(&us->dev_mutex);
913 us->max_lun = usb_stor_Bulk_max_lun(us);
914
915
916
917
918
919 if (us->max_lun >= 8)
920 us_to_host(us)->max_lun = us->max_lun+1;
921 mutex_unlock(&us->dev_mutex);
922 }
923 scsi_scan_host(us_to_host(us));
924 dev_dbg(dev, "scan complete\n");
925
926
927
928 usb_autopm_put_interface(us->pusb_intf);
929 clear_bit(US_FLIDX_SCAN_PENDING, &us->dflags);
930}
931
932static unsigned int usb_stor_sg_tablesize(struct usb_interface *intf)
933{
934 struct usb_device *usb_dev = interface_to_usbdev(intf);
935
936 if (usb_dev->bus->sg_tablesize) {
937 return usb_dev->bus->sg_tablesize;
938 }
939 return SG_ALL;
940}
941
942
943int usb_stor_probe1(struct us_data **pus,
944 struct usb_interface *intf,
945 const struct usb_device_id *id,
946 struct us_unusual_dev *unusual_dev,
947 struct scsi_host_template *sht)
948{
949 struct Scsi_Host *host;
950 struct us_data *us;
951 int result;
952
953 dev_info(&intf->dev, "USB Mass Storage device detected\n");
954
955
956
957
958
959 host = scsi_host_alloc(sht, sizeof(*us));
960 if (!host) {
961 dev_warn(&intf->dev, "Unable to allocate the scsi host\n");
962 return -ENOMEM;
963 }
964
965
966
967
968 host->max_cmd_len = 16;
969 host->sg_tablesize = usb_stor_sg_tablesize(intf);
970 *pus = us = host_to_us(host);
971 mutex_init(&(us->dev_mutex));
972 us_set_lock_class(&us->dev_mutex, intf);
973 init_completion(&us->cmnd_ready);
974 init_completion(&(us->notify));
975 init_waitqueue_head(&us->delay_wait);
976 INIT_DELAYED_WORK(&us->scan_dwork, usb_stor_scan_dwork);
977
978
979 result = associate_dev(us, intf);
980 if (result)
981 goto BadDevice;
982
983
984 result = get_device_info(us, id, unusual_dev);
985 if (result)
986 goto BadDevice;
987
988
989 get_transport(us);
990 get_protocol(us);
991
992
993
994
995
996 return 0;
997
998BadDevice:
999 usb_stor_dbg(us, "storage_probe() failed\n");
1000 release_everything(us);
1001 return result;
1002}
1003EXPORT_SYMBOL_GPL(usb_stor_probe1);
1004
1005
1006int usb_stor_probe2(struct us_data *us)
1007{
1008 int result;
1009 struct device *dev = &us->pusb_intf->dev;
1010
1011
1012 if (!us->transport || !us->proto_handler) {
1013 result = -ENXIO;
1014 goto BadDevice;
1015 }
1016 usb_stor_dbg(us, "Transport: %s\n", us->transport_name);
1017 usb_stor_dbg(us, "Protocol: %s\n", us->protocol_name);
1018
1019 if (us->fflags & US_FL_SCM_MULT_TARG) {
1020
1021
1022
1023
1024 us->max_lun = 7;
1025
1026 us_to_host(us)->this_id = 7;
1027
1028 } else {
1029
1030 us_to_host(us)->max_id = 1;
1031
1032
1033
1034
1035
1036 if (us->transport == usb_stor_Bulk_transport)
1037 us_to_host(us)->no_scsi2_lun_in_cdb = 1;
1038 }
1039
1040
1041 if (us->fflags & US_FL_SINGLE_LUN)
1042 us->max_lun = 0;
1043
1044
1045 result = get_pipes(us);
1046 if (result)
1047 goto BadDevice;
1048
1049
1050
1051
1052
1053 if (us->fflags & US_FL_INITIAL_READ10)
1054 set_bit(US_FLIDX_REDO_READ10, &us->dflags);
1055
1056
1057 result = usb_stor_acquire_resources(us);
1058 if (result)
1059 goto BadDevice;
1060 usb_autopm_get_interface_no_resume(us->pusb_intf);
1061 snprintf(us->scsi_name, sizeof(us->scsi_name), "usb-storage %s",
1062 dev_name(&us->pusb_intf->dev));
1063 result = scsi_add_host(us_to_host(us), dev);
1064 if (result) {
1065 dev_warn(dev,
1066 "Unable to add the scsi host\n");
1067 goto HostAddErr;
1068 }
1069
1070
1071 set_bit(US_FLIDX_SCAN_PENDING, &us->dflags);
1072
1073 if (delay_use > 0)
1074 dev_dbg(dev, "waiting for device to settle before scanning\n");
1075 queue_delayed_work(system_freezable_wq, &us->scan_dwork,
1076 delay_use * HZ);
1077 return 0;
1078
1079
1080HostAddErr:
1081 usb_autopm_put_interface_no_suspend(us->pusb_intf);
1082BadDevice:
1083 usb_stor_dbg(us, "storage_probe() failed\n");
1084 release_everything(us);
1085 return result;
1086}
1087EXPORT_SYMBOL_GPL(usb_stor_probe2);
1088
1089
1090void usb_stor_disconnect(struct usb_interface *intf)
1091{
1092 struct us_data *us = usb_get_intfdata(intf);
1093
1094 quiesce_and_remove_host(us);
1095 release_everything(us);
1096}
1097EXPORT_SYMBOL_GPL(usb_stor_disconnect);
1098
1099static struct scsi_host_template usb_stor_host_template;
1100
1101
1102static int storage_probe(struct usb_interface *intf,
1103 const struct usb_device_id *id)
1104{
1105 struct us_unusual_dev *unusual_dev;
1106 struct us_data *us;
1107 int result;
1108 int size;
1109
1110
1111#if IS_ENABLED(CONFIG_USB_UAS)
1112 if (uas_use_uas_driver(intf, id, NULL))
1113 return -ENXIO;
1114#endif
1115
1116
1117
1118
1119
1120 if (usb_usual_ignore_device(intf))
1121 return -ENXIO;
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131 size = ARRAY_SIZE(us_unusual_dev_list);
1132 if (id >= usb_storage_usb_ids && id < usb_storage_usb_ids + size) {
1133 unusual_dev = (id - usb_storage_usb_ids) + us_unusual_dev_list;
1134 } else {
1135 unusual_dev = &for_dynamic_ids;
1136
1137 dev_dbg(&intf->dev, "Use Bulk-Only transport with the Transparent SCSI protocol for dynamic id: 0x%04x 0x%04x\n",
1138 id->idVendor, id->idProduct);
1139 }
1140
1141 result = usb_stor_probe1(&us, intf, id, unusual_dev,
1142 &usb_stor_host_template);
1143 if (result)
1144 return result;
1145
1146
1147
1148 result = usb_stor_probe2(us);
1149 return result;
1150}
1151
1152static struct usb_driver usb_storage_driver = {
1153 .name = DRV_NAME,
1154 .probe = storage_probe,
1155 .disconnect = usb_stor_disconnect,
1156 .suspend = usb_stor_suspend,
1157 .resume = usb_stor_resume,
1158 .reset_resume = usb_stor_reset_resume,
1159 .pre_reset = usb_stor_pre_reset,
1160 .post_reset = usb_stor_post_reset,
1161 .id_table = usb_storage_usb_ids,
1162 .supports_autosuspend = 1,
1163 .soft_unbind = 1,
1164};
1165
1166module_usb_stor_driver(usb_storage_driver, usb_stor_host_template, DRV_NAME);
1167