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 *altsetting =
741 us->pusb_intf->cur_altsetting;
742 int i;
743 struct usb_endpoint_descriptor *ep;
744 struct usb_endpoint_descriptor *ep_in = NULL;
745 struct usb_endpoint_descriptor *ep_out = NULL;
746 struct usb_endpoint_descriptor *ep_int = NULL;
747
748
749
750
751
752
753
754 for (i = 0; i < altsetting->desc.bNumEndpoints; i++) {
755 ep = &altsetting->endpoint[i].desc;
756
757 if (usb_endpoint_xfer_bulk(ep)) {
758 if (usb_endpoint_dir_in(ep)) {
759 if (!ep_in)
760 ep_in = ep;
761 } else {
762 if (!ep_out)
763 ep_out = ep;
764 }
765 }
766
767 else if (usb_endpoint_is_int_in(ep)) {
768 if (!ep_int)
769 ep_int = ep;
770 }
771 }
772
773 if (!ep_in || !ep_out || (us->protocol == USB_PR_CBI && !ep_int)) {
774 usb_stor_dbg(us, "Endpoint sanity check failed! Rejecting dev.\n");
775 return -EIO;
776 }
777
778
779 us->send_ctrl_pipe = usb_sndctrlpipe(us->pusb_dev, 0);
780 us->recv_ctrl_pipe = usb_rcvctrlpipe(us->pusb_dev, 0);
781 us->send_bulk_pipe = usb_sndbulkpipe(us->pusb_dev,
782 usb_endpoint_num(ep_out));
783 us->recv_bulk_pipe = usb_rcvbulkpipe(us->pusb_dev,
784 usb_endpoint_num(ep_in));
785 if (ep_int) {
786 us->recv_intr_pipe = usb_rcvintpipe(us->pusb_dev,
787 usb_endpoint_num(ep_int));
788 us->ep_bInterval = ep_int->bInterval;
789 }
790 return 0;
791}
792
793
794static int usb_stor_acquire_resources(struct us_data *us)
795{
796 int p;
797 struct task_struct *th;
798
799 us->current_urb = usb_alloc_urb(0, GFP_KERNEL);
800 if (!us->current_urb)
801 return -ENOMEM;
802
803
804
805
806
807 if (us->unusual_dev->initFunction) {
808 p = us->unusual_dev->initFunction(us);
809 if (p)
810 return p;
811 }
812
813
814 th = kthread_run(usb_stor_control_thread, us, "usb-storage");
815 if (IS_ERR(th)) {
816 dev_warn(&us->pusb_intf->dev,
817 "Unable to start control thread\n");
818 return PTR_ERR(th);
819 }
820 us->ctl_thread = th;
821
822 return 0;
823}
824
825
826static void usb_stor_release_resources(struct us_data *us)
827{
828
829
830
831
832
833 usb_stor_dbg(us, "-- sending exit command to thread\n");
834 complete(&us->cmnd_ready);
835 if (us->ctl_thread)
836 kthread_stop(us->ctl_thread);
837
838
839 if (us->extra_destructor) {
840 usb_stor_dbg(us, "-- calling extra_destructor()\n");
841 us->extra_destructor(us->extra);
842 }
843
844
845 kfree(us->extra);
846 usb_free_urb(us->current_urb);
847}
848
849
850static void dissociate_dev(struct us_data *us)
851{
852
853 kfree(us->cr);
854 usb_free_coherent(us->pusb_dev, US_IOBUF_SIZE, us->iobuf, us->iobuf_dma);
855
856
857 usb_set_intfdata(us->pusb_intf, NULL);
858}
859
860
861
862
863
864static void quiesce_and_remove_host(struct us_data *us)
865{
866 struct Scsi_Host *host = us_to_host(us);
867
868
869 if (us->pusb_dev->state == USB_STATE_NOTATTACHED) {
870 set_bit(US_FLIDX_DISCONNECTING, &us->dflags);
871 wake_up(&us->delay_wait);
872 }
873
874
875
876
877
878 cancel_delayed_work_sync(&us->scan_dwork);
879
880
881 if (test_bit(US_FLIDX_SCAN_PENDING, &us->dflags))
882 usb_autopm_put_interface_no_suspend(us->pusb_intf);
883
884
885
886
887
888 scsi_remove_host(host);
889
890
891
892
893
894 scsi_lock(host);
895 set_bit(US_FLIDX_DISCONNECTING, &us->dflags);
896 scsi_unlock(host);
897 wake_up(&us->delay_wait);
898}
899
900
901static void release_everything(struct us_data *us)
902{
903 usb_stor_release_resources(us);
904 dissociate_dev(us);
905
906
907
908
909
910 scsi_host_put(us_to_host(us));
911}
912
913
914static void usb_stor_scan_dwork(struct work_struct *work)
915{
916 struct us_data *us = container_of(work, struct us_data,
917 scan_dwork.work);
918 struct device *dev = &us->pusb_intf->dev;
919
920 dev_dbg(dev, "starting scan\n");
921
922
923 if (us->protocol == USB_PR_BULK &&
924 !(us->fflags & US_FL_SINGLE_LUN) &&
925 !(us->fflags & US_FL_SCM_MULT_TARG)) {
926 mutex_lock(&us->dev_mutex);
927 us->max_lun = usb_stor_Bulk_max_lun(us);
928
929
930
931
932
933 if (us->max_lun >= 8)
934 us_to_host(us)->max_lun = us->max_lun+1;
935 mutex_unlock(&us->dev_mutex);
936 }
937 scsi_scan_host(us_to_host(us));
938 dev_dbg(dev, "scan complete\n");
939
940
941
942 usb_autopm_put_interface(us->pusb_intf);
943 clear_bit(US_FLIDX_SCAN_PENDING, &us->dflags);
944}
945
946static unsigned int usb_stor_sg_tablesize(struct usb_interface *intf)
947{
948 struct usb_device *usb_dev = interface_to_usbdev(intf);
949
950 if (usb_dev->bus->sg_tablesize) {
951 return usb_dev->bus->sg_tablesize;
952 }
953 return SG_ALL;
954}
955
956
957int usb_stor_probe1(struct us_data **pus,
958 struct usb_interface *intf,
959 const struct usb_device_id *id,
960 struct us_unusual_dev *unusual_dev,
961 struct scsi_host_template *sht)
962{
963 struct Scsi_Host *host;
964 struct us_data *us;
965 int result;
966
967 dev_info(&intf->dev, "USB Mass Storage device detected\n");
968
969
970
971
972
973 host = scsi_host_alloc(sht, sizeof(*us));
974 if (!host) {
975 dev_warn(&intf->dev, "Unable to allocate the scsi host\n");
976 return -ENOMEM;
977 }
978
979
980
981
982 host->max_cmd_len = 16;
983 host->sg_tablesize = usb_stor_sg_tablesize(intf);
984 *pus = us = host_to_us(host);
985 mutex_init(&(us->dev_mutex));
986 us_set_lock_class(&us->dev_mutex, intf);
987 init_completion(&us->cmnd_ready);
988 init_completion(&(us->notify));
989 init_waitqueue_head(&us->delay_wait);
990 INIT_DELAYED_WORK(&us->scan_dwork, usb_stor_scan_dwork);
991
992
993 result = associate_dev(us, intf);
994 if (result)
995 goto BadDevice;
996
997
998 result = get_device_info(us, id, unusual_dev);
999 if (result)
1000 goto BadDevice;
1001
1002
1003 get_transport(us);
1004 get_protocol(us);
1005
1006
1007
1008
1009
1010 return 0;
1011
1012BadDevice:
1013 usb_stor_dbg(us, "storage_probe() failed\n");
1014 release_everything(us);
1015 return result;
1016}
1017EXPORT_SYMBOL_GPL(usb_stor_probe1);
1018
1019
1020int usb_stor_probe2(struct us_data *us)
1021{
1022 int result;
1023 struct device *dev = &us->pusb_intf->dev;
1024
1025
1026 if (!us->transport || !us->proto_handler) {
1027 result = -ENXIO;
1028 goto BadDevice;
1029 }
1030 usb_stor_dbg(us, "Transport: %s\n", us->transport_name);
1031 usb_stor_dbg(us, "Protocol: %s\n", us->protocol_name);
1032
1033 if (us->fflags & US_FL_SCM_MULT_TARG) {
1034
1035
1036
1037
1038 us->max_lun = 7;
1039
1040 us_to_host(us)->this_id = 7;
1041
1042 } else {
1043
1044 us_to_host(us)->max_id = 1;
1045
1046
1047
1048
1049
1050 if (us->transport == usb_stor_Bulk_transport)
1051 us_to_host(us)->no_scsi2_lun_in_cdb = 1;
1052 }
1053
1054
1055 if (us->fflags & US_FL_SINGLE_LUN)
1056 us->max_lun = 0;
1057
1058
1059 result = get_pipes(us);
1060 if (result)
1061 goto BadDevice;
1062
1063
1064
1065
1066
1067 if (us->fflags & US_FL_INITIAL_READ10)
1068 set_bit(US_FLIDX_REDO_READ10, &us->dflags);
1069
1070
1071 result = usb_stor_acquire_resources(us);
1072 if (result)
1073 goto BadDevice;
1074 usb_autopm_get_interface_no_resume(us->pusb_intf);
1075 snprintf(us->scsi_name, sizeof(us->scsi_name), "usb-storage %s",
1076 dev_name(&us->pusb_intf->dev));
1077 result = scsi_add_host(us_to_host(us), dev);
1078 if (result) {
1079 dev_warn(dev,
1080 "Unable to add the scsi host\n");
1081 goto HostAddErr;
1082 }
1083
1084
1085 set_bit(US_FLIDX_SCAN_PENDING, &us->dflags);
1086
1087 if (delay_use > 0)
1088 dev_dbg(dev, "waiting for device to settle before scanning\n");
1089 queue_delayed_work(system_freezable_wq, &us->scan_dwork,
1090 delay_use * HZ);
1091 return 0;
1092
1093
1094HostAddErr:
1095 usb_autopm_put_interface_no_suspend(us->pusb_intf);
1096BadDevice:
1097 usb_stor_dbg(us, "storage_probe() failed\n");
1098 release_everything(us);
1099 return result;
1100}
1101EXPORT_SYMBOL_GPL(usb_stor_probe2);
1102
1103
1104void usb_stor_disconnect(struct usb_interface *intf)
1105{
1106 struct us_data *us = usb_get_intfdata(intf);
1107
1108 quiesce_and_remove_host(us);
1109 release_everything(us);
1110}
1111EXPORT_SYMBOL_GPL(usb_stor_disconnect);
1112
1113static struct scsi_host_template usb_stor_host_template;
1114
1115
1116static int storage_probe(struct usb_interface *intf,
1117 const struct usb_device_id *id)
1118{
1119 struct us_unusual_dev *unusual_dev;
1120 struct us_data *us;
1121 int result;
1122 int size;
1123
1124
1125#if IS_ENABLED(CONFIG_USB_UAS)
1126 if (uas_use_uas_driver(intf, id, NULL))
1127 return -ENXIO;
1128#endif
1129
1130
1131
1132
1133
1134 if (usb_usual_ignore_device(intf))
1135 return -ENXIO;
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145 size = ARRAY_SIZE(us_unusual_dev_list);
1146 if (id >= usb_storage_usb_ids && id < usb_storage_usb_ids + size) {
1147 unusual_dev = (id - usb_storage_usb_ids) + us_unusual_dev_list;
1148 } else {
1149 unusual_dev = &for_dynamic_ids;
1150
1151 dev_dbg(&intf->dev, "Use Bulk-Only transport with the Transparent SCSI protocol for dynamic id: 0x%04x 0x%04x\n",
1152 id->idVendor, id->idProduct);
1153 }
1154
1155 result = usb_stor_probe1(&us, intf, id, unusual_dev,
1156 &usb_stor_host_template);
1157 if (result)
1158 return result;
1159
1160
1161
1162 result = usb_stor_probe2(us);
1163 return result;
1164}
1165
1166static struct usb_driver usb_storage_driver = {
1167 .name = DRV_NAME,
1168 .probe = storage_probe,
1169 .disconnect = usb_stor_disconnect,
1170 .suspend = usb_stor_suspend,
1171 .resume = usb_stor_resume,
1172 .reset_resume = usb_stor_reset_resume,
1173 .pre_reset = usb_stor_pre_reset,
1174 .post_reset = usb_stor_post_reset,
1175 .id_table = usb_storage_usb_ids,
1176 .supports_autosuspend = 1,
1177 .soft_unbind = 1,
1178};
1179
1180module_usb_stor_driver(usb_storage_driver, usb_stor_host_template, DRV_NAME);
1181