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#include <linux/sched.h>
47#include <linux/gfp.h>
48#include <linux/errno.h>
49#include <linux/export.h>
50
51#include <linux/usb/quirks.h>
52
53#include <scsi/scsi.h>
54#include <scsi/scsi_eh.h>
55#include <scsi/scsi_device.h>
56
57#include "usb.h"
58#include "transport.h"
59#include "protocol.h"
60#include "scsiglue.h"
61#include "debug.h"
62
63#include <linux/blkdev.h>
64#include "../../scsi/sd.h"
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115static void usb_stor_blocking_completion(struct urb *urb)
116{
117 struct completion *urb_done_ptr = urb->context;
118
119 complete(urb_done_ptr);
120}
121
122
123
124
125
126
127
128static int usb_stor_msg_common(struct us_data *us, int timeout)
129{
130 struct completion urb_done;
131 long timeleft;
132 int status;
133
134
135 if (test_bit(US_FLIDX_ABORTING, &us->dflags))
136 return -EIO;
137
138
139 init_completion(&urb_done);
140
141
142 us->current_urb->context = &urb_done;
143 us->current_urb->transfer_flags = 0;
144
145
146
147
148
149 if (us->current_urb->transfer_buffer == us->iobuf)
150 us->current_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
151 us->current_urb->transfer_dma = us->iobuf_dma;
152
153
154 status = usb_submit_urb(us->current_urb, GFP_NOIO);
155 if (status) {
156
157 return status;
158 }
159
160
161
162 set_bit(US_FLIDX_URB_ACTIVE, &us->dflags);
163
164
165 if (test_bit(US_FLIDX_ABORTING, &us->dflags)) {
166
167
168 if (test_and_clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags)) {
169 usb_stor_dbg(us, "-- cancelling URB\n");
170 usb_unlink_urb(us->current_urb);
171 }
172 }
173
174
175 timeleft = wait_for_completion_interruptible_timeout(
176 &urb_done, timeout ? : MAX_SCHEDULE_TIMEOUT);
177
178 clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags);
179
180 if (timeleft <= 0) {
181 usb_stor_dbg(us, "%s -- cancelling URB\n",
182 timeleft == 0 ? "Timeout" : "Signal");
183 usb_kill_urb(us->current_urb);
184 }
185
186
187 return us->current_urb->status;
188}
189
190
191
192
193
194int usb_stor_control_msg(struct us_data *us, unsigned int pipe,
195 u8 request, u8 requesttype, u16 value, u16 index,
196 void *data, u16 size, int timeout)
197{
198 int status;
199
200 usb_stor_dbg(us, "rq=%02x rqtype=%02x value=%04x index=%02x len=%u\n",
201 request, requesttype, value, index, size);
202
203
204 us->cr->bRequestType = requesttype;
205 us->cr->bRequest = request;
206 us->cr->wValue = cpu_to_le16(value);
207 us->cr->wIndex = cpu_to_le16(index);
208 us->cr->wLength = cpu_to_le16(size);
209
210
211 usb_fill_control_urb(us->current_urb, us->pusb_dev, pipe,
212 (unsigned char*) us->cr, data, size,
213 usb_stor_blocking_completion, NULL);
214 status = usb_stor_msg_common(us, timeout);
215
216
217 if (status == 0)
218 status = us->current_urb->actual_length;
219 return status;
220}
221EXPORT_SYMBOL_GPL(usb_stor_control_msg);
222
223
224
225
226
227
228
229
230
231
232
233
234
235int usb_stor_clear_halt(struct us_data *us, unsigned int pipe)
236{
237 int result;
238 int endp = usb_pipeendpoint(pipe);
239
240 if (usb_pipein (pipe))
241 endp |= USB_DIR_IN;
242
243 result = usb_stor_control_msg(us, us->send_ctrl_pipe,
244 USB_REQ_CLEAR_FEATURE, USB_RECIP_ENDPOINT,
245 USB_ENDPOINT_HALT, endp,
246 NULL, 0, 3*HZ);
247
248 if (result >= 0)
249 usb_reset_endpoint(us->pusb_dev, endp);
250
251 usb_stor_dbg(us, "result = %d\n", result);
252 return result;
253}
254EXPORT_SYMBOL_GPL(usb_stor_clear_halt);
255
256
257
258
259
260
261
262
263
264static int interpret_urb_result(struct us_data *us, unsigned int pipe,
265 unsigned int length, int result, unsigned int partial)
266{
267 usb_stor_dbg(us, "Status code %d; transferred %u/%u\n",
268 result, partial, length);
269 switch (result) {
270
271
272 case 0:
273 if (partial != length) {
274 usb_stor_dbg(us, "-- short transfer\n");
275 return USB_STOR_XFER_SHORT;
276 }
277
278 usb_stor_dbg(us, "-- transfer complete\n");
279 return USB_STOR_XFER_GOOD;
280
281
282 case -EPIPE:
283
284
285 if (usb_pipecontrol(pipe)) {
286 usb_stor_dbg(us, "-- stall on control pipe\n");
287 return USB_STOR_XFER_STALLED;
288 }
289
290
291 usb_stor_dbg(us, "clearing endpoint halt for pipe 0x%x\n",
292 pipe);
293 if (usb_stor_clear_halt(us, pipe) < 0)
294 return USB_STOR_XFER_ERROR;
295 return USB_STOR_XFER_STALLED;
296
297
298 case -EOVERFLOW:
299 usb_stor_dbg(us, "-- babble\n");
300 return USB_STOR_XFER_LONG;
301
302
303 case -ECONNRESET:
304 usb_stor_dbg(us, "-- transfer cancelled\n");
305 return USB_STOR_XFER_ERROR;
306
307
308 case -EREMOTEIO:
309 usb_stor_dbg(us, "-- short read transfer\n");
310 return USB_STOR_XFER_SHORT;
311
312
313 case -EIO:
314 usb_stor_dbg(us, "-- abort or disconnect in progress\n");
315 return USB_STOR_XFER_ERROR;
316
317
318 default:
319 usb_stor_dbg(us, "-- unknown error\n");
320 return USB_STOR_XFER_ERROR;
321 }
322}
323
324
325
326
327
328int usb_stor_ctrl_transfer(struct us_data *us, unsigned int pipe,
329 u8 request, u8 requesttype, u16 value, u16 index,
330 void *data, u16 size)
331{
332 int result;
333
334 usb_stor_dbg(us, "rq=%02x rqtype=%02x value=%04x index=%02x len=%u\n",
335 request, requesttype, value, index, size);
336
337
338 us->cr->bRequestType = requesttype;
339 us->cr->bRequest = request;
340 us->cr->wValue = cpu_to_le16(value);
341 us->cr->wIndex = cpu_to_le16(index);
342 us->cr->wLength = cpu_to_le16(size);
343
344
345 usb_fill_control_urb(us->current_urb, us->pusb_dev, pipe,
346 (unsigned char*) us->cr, data, size,
347 usb_stor_blocking_completion, NULL);
348 result = usb_stor_msg_common(us, 0);
349
350 return interpret_urb_result(us, pipe, size, result,
351 us->current_urb->actual_length);
352}
353EXPORT_SYMBOL_GPL(usb_stor_ctrl_transfer);
354
355
356
357
358
359
360
361
362static int usb_stor_intr_transfer(struct us_data *us, void *buf,
363 unsigned int length)
364{
365 int result;
366 unsigned int pipe = us->recv_intr_pipe;
367 unsigned int maxp;
368
369 usb_stor_dbg(us, "xfer %u bytes\n", length);
370
371
372 maxp = usb_maxpacket(us->pusb_dev, pipe, usb_pipeout(pipe));
373 if (maxp > length)
374 maxp = length;
375
376
377 usb_fill_int_urb(us->current_urb, us->pusb_dev, pipe, buf,
378 maxp, usb_stor_blocking_completion, NULL,
379 us->ep_bInterval);
380 result = usb_stor_msg_common(us, 0);
381
382 return interpret_urb_result(us, pipe, length, result,
383 us->current_urb->actual_length);
384}
385
386
387
388
389
390
391int usb_stor_bulk_transfer_buf(struct us_data *us, unsigned int pipe,
392 void *buf, unsigned int length, unsigned int *act_len)
393{
394 int result;
395
396 usb_stor_dbg(us, "xfer %u bytes\n", length);
397
398
399 usb_fill_bulk_urb(us->current_urb, us->pusb_dev, pipe, buf, length,
400 usb_stor_blocking_completion, NULL);
401 result = usb_stor_msg_common(us, 0);
402
403
404 if (act_len)
405 *act_len = us->current_urb->actual_length;
406 return interpret_urb_result(us, pipe, length, result,
407 us->current_urb->actual_length);
408}
409EXPORT_SYMBOL_GPL(usb_stor_bulk_transfer_buf);
410
411
412
413
414
415
416
417static int usb_stor_bulk_transfer_sglist(struct us_data *us, unsigned int pipe,
418 struct scatterlist *sg, int num_sg, unsigned int length,
419 unsigned int *act_len)
420{
421 int result;
422
423
424 if (test_bit(US_FLIDX_ABORTING, &us->dflags))
425 return USB_STOR_XFER_ERROR;
426
427
428 usb_stor_dbg(us, "xfer %u bytes, %d entries\n", length, num_sg);
429 result = usb_sg_init(&us->current_sg, us->pusb_dev, pipe, 0,
430 sg, num_sg, length, GFP_NOIO);
431 if (result) {
432 usb_stor_dbg(us, "usb_sg_init returned %d\n", result);
433 return USB_STOR_XFER_ERROR;
434 }
435
436
437
438 set_bit(US_FLIDX_SG_ACTIVE, &us->dflags);
439
440
441 if (test_bit(US_FLIDX_ABORTING, &us->dflags)) {
442
443
444 if (test_and_clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags)) {
445 usb_stor_dbg(us, "-- cancelling sg request\n");
446 usb_sg_cancel(&us->current_sg);
447 }
448 }
449
450
451 usb_sg_wait(&us->current_sg);
452 clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags);
453
454 result = us->current_sg.status;
455 if (act_len)
456 *act_len = us->current_sg.bytes;
457 return interpret_urb_result(us, pipe, length, result,
458 us->current_sg.bytes);
459}
460
461
462
463
464
465int usb_stor_bulk_srb(struct us_data* us, unsigned int pipe,
466 struct scsi_cmnd* srb)
467{
468 unsigned int partial;
469 int result = usb_stor_bulk_transfer_sglist(us, pipe, scsi_sglist(srb),
470 scsi_sg_count(srb), scsi_bufflen(srb),
471 &partial);
472
473 scsi_set_resid(srb, scsi_bufflen(srb) - partial);
474 return result;
475}
476EXPORT_SYMBOL_GPL(usb_stor_bulk_srb);
477
478
479
480
481
482
483
484
485
486
487int usb_stor_bulk_transfer_sg(struct us_data* us, unsigned int pipe,
488 void *buf, unsigned int length_left, int use_sg, int *residual)
489{
490 int result;
491 unsigned int partial;
492
493
494 if (use_sg) {
495
496 result = usb_stor_bulk_transfer_sglist(us, pipe,
497 (struct scatterlist *) buf, use_sg,
498 length_left, &partial);
499 length_left -= partial;
500 } else {
501
502 result = usb_stor_bulk_transfer_buf(us, pipe, buf,
503 length_left, &partial);
504 length_left -= partial;
505 }
506
507
508 if (residual)
509 *residual = length_left;
510 return result;
511}
512EXPORT_SYMBOL_GPL(usb_stor_bulk_transfer_sg);
513
514
515
516
517
518
519
520
521
522static void last_sector_hacks(struct us_data *us, struct scsi_cmnd *srb)
523{
524 struct gendisk *disk;
525 struct scsi_disk *sdkp;
526 u32 sector;
527
528
529 static unsigned char record_not_found[18] = {
530 [0] = 0x70,
531 [2] = MEDIUM_ERROR,
532 [7] = 0x0a,
533 [12] = 0x14
534 };
535
536
537
538
539
540
541 if (!us->use_last_sector_hacks)
542 return;
543
544
545 if (srb->cmnd[0] != READ_10 && srb->cmnd[0] != WRITE_10)
546 goto done;
547
548
549 sector = (srb->cmnd[2] << 24) | (srb->cmnd[3] << 16) |
550 (srb->cmnd[4] << 8) | (srb->cmnd[5]);
551 disk = srb->request->rq_disk;
552 if (!disk)
553 goto done;
554 sdkp = scsi_disk(disk);
555 if (!sdkp)
556 goto done;
557 if (sector + 1 != sdkp->capacity)
558 goto done;
559
560 if (srb->result == SAM_STAT_GOOD && scsi_get_resid(srb) == 0) {
561
562
563
564
565 us->use_last_sector_hacks = 0;
566
567 } else {
568
569
570
571
572
573
574
575
576 if (++us->last_sector_retries < 3)
577 return;
578 srb->result = SAM_STAT_CHECK_CONDITION;
579 memcpy(srb->sense_buffer, record_not_found,
580 sizeof(record_not_found));
581 }
582
583 done:
584
585
586
587
588 if (srb->cmnd[0] != TEST_UNIT_READY)
589 us->last_sector_retries = 0;
590}
591
592
593
594
595
596
597void usb_stor_invoke_transport(struct scsi_cmnd *srb, struct us_data *us)
598{
599 int need_auto_sense;
600 int result;
601
602
603 scsi_set_resid(srb, 0);
604 result = us->transport(srb, us);
605
606
607
608
609 if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
610 usb_stor_dbg(us, "-- command was aborted\n");
611 srb->result = DID_ABORT << 16;
612 goto Handle_Errors;
613 }
614
615
616 if (result == USB_STOR_TRANSPORT_ERROR) {
617 usb_stor_dbg(us, "-- transport indicates error, resetting\n");
618 srb->result = DID_ERROR << 16;
619 goto Handle_Errors;
620 }
621
622
623 if (result == USB_STOR_TRANSPORT_NO_SENSE) {
624 srb->result = SAM_STAT_CHECK_CONDITION;
625 last_sector_hacks(us, srb);
626 return;
627 }
628
629 srb->result = SAM_STAT_GOOD;
630
631
632
633
634
635
636 need_auto_sense = 0;
637
638
639
640
641
642
643
644 if ((us->protocol == USB_PR_CB || us->protocol == USB_PR_DPCM_USB) &&
645 srb->sc_data_direction != DMA_FROM_DEVICE) {
646 usb_stor_dbg(us, "-- CB transport device requiring auto-sense\n");
647 need_auto_sense = 1;
648 }
649
650
651
652
653
654
655 if (result == USB_STOR_TRANSPORT_FAILED) {
656 usb_stor_dbg(us, "-- transport indicates command failure\n");
657 need_auto_sense = 1;
658 }
659
660
661
662
663
664
665
666 if (unlikely((srb->cmnd[0] == ATA_16 || srb->cmnd[0] == ATA_12) &&
667 result == USB_STOR_TRANSPORT_GOOD &&
668 !(us->fflags & US_FL_SANE_SENSE) &&
669 !(us->fflags & US_FL_BAD_SENSE) &&
670 !(srb->cmnd[2] & 0x20))) {
671 usb_stor_dbg(us, "-- SAT supported, increasing auto-sense\n");
672 us->fflags |= US_FL_SANE_SENSE;
673 }
674
675
676
677
678
679 if ((scsi_get_resid(srb) > 0) &&
680 !((srb->cmnd[0] == REQUEST_SENSE) ||
681 (srb->cmnd[0] == INQUIRY) ||
682 (srb->cmnd[0] == MODE_SENSE) ||
683 (srb->cmnd[0] == LOG_SENSE) ||
684 (srb->cmnd[0] == MODE_SENSE_10))) {
685 usb_stor_dbg(us, "-- unexpectedly short transfer\n");
686 }
687
688
689 if (need_auto_sense) {
690 int temp_result;
691 struct scsi_eh_save ses;
692 int sense_size = US_SENSE_SIZE;
693 struct scsi_sense_hdr sshdr;
694 const u8 *scdd;
695 u8 fm_ili;
696
697
698 if (us->fflags & US_FL_SANE_SENSE)
699 sense_size = ~0;
700Retry_Sense:
701 usb_stor_dbg(us, "Issuing auto-REQUEST_SENSE\n");
702
703 scsi_eh_prep_cmnd(srb, &ses, NULL, 0, sense_size);
704
705
706 if (us->subclass == USB_SC_RBC || us->subclass == USB_SC_SCSI ||
707 us->subclass == USB_SC_CYP_ATACB)
708 srb->cmd_len = 6;
709 else
710 srb->cmd_len = 12;
711
712
713 scsi_set_resid(srb, 0);
714 temp_result = us->transport(us->srb, us);
715
716
717 scsi_eh_restore_cmnd(srb, &ses);
718
719 if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
720 usb_stor_dbg(us, "-- auto-sense aborted\n");
721 srb->result = DID_ABORT << 16;
722
723
724 if (sense_size != US_SENSE_SIZE) {
725 us->fflags &= ~US_FL_SANE_SENSE;
726 us->fflags |= US_FL_BAD_SENSE;
727 }
728 goto Handle_Errors;
729 }
730
731
732
733
734
735
736 if (temp_result == USB_STOR_TRANSPORT_FAILED &&
737 sense_size != US_SENSE_SIZE) {
738 usb_stor_dbg(us, "-- auto-sense failure, retry small sense\n");
739 sense_size = US_SENSE_SIZE;
740 us->fflags &= ~US_FL_SANE_SENSE;
741 us->fflags |= US_FL_BAD_SENSE;
742 goto Retry_Sense;
743 }
744
745
746 if (temp_result != USB_STOR_TRANSPORT_GOOD) {
747 usb_stor_dbg(us, "-- auto-sense failure\n");
748
749
750
751
752
753 srb->result = DID_ERROR << 16;
754 if (!(us->fflags & US_FL_SCM_MULT_TARG))
755 goto Handle_Errors;
756 return;
757 }
758
759
760
761
762
763 if (srb->sense_buffer[7] > (US_SENSE_SIZE - 8) &&
764 !(us->fflags & US_FL_SANE_SENSE) &&
765 !(us->fflags & US_FL_BAD_SENSE) &&
766 (srb->sense_buffer[0] & 0x7C) == 0x70) {
767 usb_stor_dbg(us, "-- SANE_SENSE support enabled\n");
768 us->fflags |= US_FL_SANE_SENSE;
769
770
771
772
773 usb_stor_dbg(us, "-- Sense data truncated to %i from %i\n",
774 US_SENSE_SIZE,
775 srb->sense_buffer[7] + 8);
776 srb->sense_buffer[7] = (US_SENSE_SIZE - 8);
777 }
778
779 scsi_normalize_sense(srb->sense_buffer, SCSI_SENSE_BUFFERSIZE,
780 &sshdr);
781
782 usb_stor_dbg(us, "-- Result from auto-sense is %d\n",
783 temp_result);
784 usb_stor_dbg(us, "-- code: 0x%x, key: 0x%x, ASC: 0x%x, ASCQ: 0x%x\n",
785 sshdr.response_code, sshdr.sense_key,
786 sshdr.asc, sshdr.ascq);
787#ifdef CONFIG_USB_STORAGE_DEBUG
788 usb_stor_show_sense(us, sshdr.sense_key, sshdr.asc, sshdr.ascq);
789#endif
790
791
792 srb->result = SAM_STAT_CHECK_CONDITION;
793
794 scdd = scsi_sense_desc_find(srb->sense_buffer,
795 SCSI_SENSE_BUFFERSIZE, 4);
796 fm_ili = (scdd ? scdd[3] : srb->sense_buffer[2]) & 0xA0;
797
798
799
800
801
802 if (sshdr.sense_key == 0 && sshdr.asc == 0 && sshdr.ascq == 0 &&
803 fm_ili == 0) {
804
805
806
807
808 if (result == USB_STOR_TRANSPORT_GOOD) {
809 srb->result = SAM_STAT_GOOD;
810 srb->sense_buffer[0] = 0x0;
811
812
813
814
815
816 } else {
817 srb->result = DID_ERROR << 16;
818 if ((sshdr.response_code & 0x72) == 0x72)
819 srb->sense_buffer[1] = HARDWARE_ERROR;
820 else
821 srb->sense_buffer[2] = HARDWARE_ERROR;
822 }
823 }
824 }
825
826
827
828
829
830
831
832
833
834 if (unlikely((us->fflags & US_FL_INITIAL_READ10) &&
835 srb->cmnd[0] == READ_10)) {
836 if (srb->result == SAM_STAT_GOOD) {
837 set_bit(US_FLIDX_READ10_WORKED, &us->dflags);
838 } else if (test_bit(US_FLIDX_READ10_WORKED, &us->dflags)) {
839 clear_bit(US_FLIDX_READ10_WORKED, &us->dflags);
840 set_bit(US_FLIDX_REDO_READ10, &us->dflags);
841 }
842
843
844
845
846
847
848 if (test_bit(US_FLIDX_REDO_READ10, &us->dflags)) {
849 clear_bit(US_FLIDX_REDO_READ10, &us->dflags);
850 srb->result = DID_IMM_RETRY << 16;
851 srb->sense_buffer[0] = 0;
852 }
853 }
854
855
856 if ((srb->result == SAM_STAT_GOOD || srb->sense_buffer[2] == 0) &&
857 scsi_bufflen(srb) - scsi_get_resid(srb) < srb->underflow)
858 srb->result = DID_ERROR << 16;
859
860 last_sector_hacks(us, srb);
861 return;
862
863
864
865
866 Handle_Errors:
867
868
869
870 scsi_lock(us_to_host(us));
871 set_bit(US_FLIDX_RESETTING, &us->dflags);
872 clear_bit(US_FLIDX_ABORTING, &us->dflags);
873 scsi_unlock(us_to_host(us));
874
875
876
877 mutex_unlock(&us->dev_mutex);
878 result = usb_stor_port_reset(us);
879 mutex_lock(&us->dev_mutex);
880
881 if (result < 0) {
882 scsi_lock(us_to_host(us));
883 usb_stor_report_device_reset(us);
884 scsi_unlock(us_to_host(us));
885 us->transport_reset(us);
886 }
887 clear_bit(US_FLIDX_RESETTING, &us->dflags);
888 last_sector_hacks(us, srb);
889}
890
891
892void usb_stor_stop_transport(struct us_data *us)
893{
894
895
896
897
898 if (test_and_clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags)) {
899 usb_stor_dbg(us, "-- cancelling URB\n");
900 usb_unlink_urb(us->current_urb);
901 }
902
903
904 if (test_and_clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags)) {
905 usb_stor_dbg(us, "-- cancelling sg request\n");
906 usb_sg_cancel(&us->current_sg);
907 }
908}
909
910
911
912
913
914int usb_stor_CB_transport(struct scsi_cmnd *srb, struct us_data *us)
915{
916 unsigned int transfer_length = scsi_bufflen(srb);
917 unsigned int pipe = 0;
918 int result;
919
920
921
922 result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
923 US_CBI_ADSC,
924 USB_TYPE_CLASS | USB_RECIP_INTERFACE, 0,
925 us->ifnum, srb->cmnd, srb->cmd_len);
926
927
928 usb_stor_dbg(us, "Call to usb_stor_ctrl_transfer() returned %d\n",
929 result);
930
931
932 if (result == USB_STOR_XFER_STALLED) {
933 return USB_STOR_TRANSPORT_FAILED;
934 }
935
936
937 if (result != USB_STOR_XFER_GOOD) {
938 return USB_STOR_TRANSPORT_ERROR;
939 }
940
941
942
943 if (transfer_length) {
944 pipe = srb->sc_data_direction == DMA_FROM_DEVICE ?
945 us->recv_bulk_pipe : us->send_bulk_pipe;
946 result = usb_stor_bulk_srb(us, pipe, srb);
947 usb_stor_dbg(us, "CBI data stage result is 0x%x\n", result);
948
949
950 if (result == USB_STOR_XFER_STALLED)
951 return USB_STOR_TRANSPORT_FAILED;
952 if (result > USB_STOR_XFER_STALLED)
953 return USB_STOR_TRANSPORT_ERROR;
954 }
955
956
957
958
959
960
961 if (us->protocol != USB_PR_CBI)
962 return USB_STOR_TRANSPORT_GOOD;
963
964 result = usb_stor_intr_transfer(us, us->iobuf, 2);
965 usb_stor_dbg(us, "Got interrupt data (0x%x, 0x%x)\n",
966 us->iobuf[0], us->iobuf[1]);
967 if (result != USB_STOR_XFER_GOOD)
968 return USB_STOR_TRANSPORT_ERROR;
969
970
971
972
973
974
975
976
977 if (us->subclass == USB_SC_UFI) {
978 if (srb->cmnd[0] == REQUEST_SENSE ||
979 srb->cmnd[0] == INQUIRY)
980 return USB_STOR_TRANSPORT_GOOD;
981 if (us->iobuf[0])
982 goto Failed;
983 return USB_STOR_TRANSPORT_GOOD;
984 }
985
986
987
988
989
990
991
992 if (us->iobuf[0]) {
993 usb_stor_dbg(us, "CBI IRQ data showed reserved bType 0x%x\n",
994 us->iobuf[0]);
995 goto Failed;
996
997 }
998
999
1000 switch (us->iobuf[1] & 0x0F) {
1001 case 0x00:
1002 return USB_STOR_TRANSPORT_GOOD;
1003 case 0x01:
1004 goto Failed;
1005 }
1006 return USB_STOR_TRANSPORT_ERROR;
1007
1008
1009
1010
1011 Failed:
1012 if (pipe)
1013 usb_stor_clear_halt(us, pipe);
1014 return USB_STOR_TRANSPORT_FAILED;
1015}
1016EXPORT_SYMBOL_GPL(usb_stor_CB_transport);
1017
1018
1019
1020
1021
1022
1023int usb_stor_Bulk_max_lun(struct us_data *us)
1024{
1025 int result;
1026
1027
1028 us->iobuf[0] = 0;
1029 result = usb_stor_control_msg(us, us->recv_ctrl_pipe,
1030 US_BULK_GET_MAX_LUN,
1031 USB_DIR_IN | USB_TYPE_CLASS |
1032 USB_RECIP_INTERFACE,
1033 0, us->ifnum, us->iobuf, 1, 10*HZ);
1034
1035 usb_stor_dbg(us, "GetMaxLUN command result is %d, data is %d\n",
1036 result, us->iobuf[0]);
1037
1038
1039
1040
1041
1042
1043 if (result > 0) {
1044 if (us->iobuf[0] < 16) {
1045 return us->iobuf[0];
1046 } else {
1047 dev_info(&us->pusb_intf->dev,
1048 "Max LUN %d is not valid, using 0 instead",
1049 us->iobuf[0]);
1050 }
1051 }
1052
1053
1054
1055
1056
1057
1058
1059
1060 return 0;
1061}
1062
1063int usb_stor_Bulk_transport(struct scsi_cmnd *srb, struct us_data *us)
1064{
1065 struct bulk_cb_wrap *bcb = (struct bulk_cb_wrap *) us->iobuf;
1066 struct bulk_cs_wrap *bcs = (struct bulk_cs_wrap *) us->iobuf;
1067 unsigned int transfer_length = scsi_bufflen(srb);
1068 unsigned int residue;
1069 int result;
1070 int fake_sense = 0;
1071 unsigned int cswlen;
1072 unsigned int cbwlen = US_BULK_CB_WRAP_LEN;
1073
1074
1075 if (unlikely(us->fflags & US_FL_BULK32)) {
1076 cbwlen = 32;
1077 us->iobuf[31] = 0;
1078 }
1079
1080
1081 bcb->Signature = cpu_to_le32(US_BULK_CB_SIGN);
1082 bcb->DataTransferLength = cpu_to_le32(transfer_length);
1083 bcb->Flags = srb->sc_data_direction == DMA_FROM_DEVICE ?
1084 US_BULK_FLAG_IN : 0;
1085 bcb->Tag = ++us->tag;
1086 bcb->Lun = srb->device->lun;
1087 if (us->fflags & US_FL_SCM_MULT_TARG)
1088 bcb->Lun |= srb->device->id << 4;
1089 bcb->Length = srb->cmd_len;
1090
1091
1092 memset(bcb->CDB, 0, sizeof(bcb->CDB));
1093 memcpy(bcb->CDB, srb->cmnd, bcb->Length);
1094
1095
1096 usb_stor_dbg(us, "Bulk Command S 0x%x T 0x%x L %d F %d Trg %d LUN %d CL %d\n",
1097 le32_to_cpu(bcb->Signature), bcb->Tag,
1098 le32_to_cpu(bcb->DataTransferLength), bcb->Flags,
1099 (bcb->Lun >> 4), (bcb->Lun & 0x0F),
1100 bcb->Length);
1101 result = usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,
1102 bcb, cbwlen, NULL);
1103 usb_stor_dbg(us, "Bulk command transfer result=%d\n", result);
1104 if (result != USB_STOR_XFER_GOOD)
1105 return USB_STOR_TRANSPORT_ERROR;
1106
1107
1108
1109
1110
1111
1112
1113 if (unlikely(us->fflags & US_FL_GO_SLOW))
1114 usleep_range(125, 150);
1115
1116 if (transfer_length) {
1117 unsigned int pipe = srb->sc_data_direction == DMA_FROM_DEVICE ?
1118 us->recv_bulk_pipe : us->send_bulk_pipe;
1119 result = usb_stor_bulk_srb(us, pipe, srb);
1120 usb_stor_dbg(us, "Bulk data transfer result 0x%x\n", result);
1121 if (result == USB_STOR_XFER_ERROR)
1122 return USB_STOR_TRANSPORT_ERROR;
1123
1124
1125
1126
1127
1128
1129
1130 if (result == USB_STOR_XFER_LONG)
1131 fake_sense = 1;
1132
1133
1134
1135
1136
1137
1138
1139 if (result == USB_STOR_XFER_SHORT &&
1140 srb->sc_data_direction == DMA_FROM_DEVICE &&
1141 transfer_length - scsi_get_resid(srb) ==
1142 US_BULK_CS_WRAP_LEN) {
1143 struct scatterlist *sg = NULL;
1144 unsigned int offset = 0;
1145
1146 if (usb_stor_access_xfer_buf((unsigned char *) bcs,
1147 US_BULK_CS_WRAP_LEN, srb, &sg,
1148 &offset, FROM_XFER_BUF) ==
1149 US_BULK_CS_WRAP_LEN &&
1150 bcs->Signature ==
1151 cpu_to_le32(US_BULK_CS_SIGN)) {
1152 usb_stor_dbg(us, "Device skipped data phase\n");
1153 scsi_set_resid(srb, transfer_length);
1154 goto skipped_data_phase;
1155 }
1156 }
1157 }
1158
1159
1160
1161
1162
1163
1164 usb_stor_dbg(us, "Attempting to get CSW...\n");
1165 result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1166 bcs, US_BULK_CS_WRAP_LEN, &cswlen);
1167
1168
1169
1170
1171
1172 if (result == USB_STOR_XFER_SHORT && cswlen == 0) {
1173 usb_stor_dbg(us, "Received 0-length CSW; retrying...\n");
1174 result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1175 bcs, US_BULK_CS_WRAP_LEN, &cswlen);
1176 }
1177
1178
1179 if (result == USB_STOR_XFER_STALLED) {
1180
1181
1182 usb_stor_dbg(us, "Attempting to get CSW (2nd try)...\n");
1183 result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1184 bcs, US_BULK_CS_WRAP_LEN, NULL);
1185 }
1186
1187
1188 usb_stor_dbg(us, "Bulk status result = %d\n", result);
1189 if (result != USB_STOR_XFER_GOOD)
1190 return USB_STOR_TRANSPORT_ERROR;
1191
1192 skipped_data_phase:
1193
1194 residue = le32_to_cpu(bcs->Residue);
1195 usb_stor_dbg(us, "Bulk Status S 0x%x T 0x%x R %u Stat 0x%x\n",
1196 le32_to_cpu(bcs->Signature), bcs->Tag,
1197 residue, bcs->Status);
1198 if (!(bcs->Tag == us->tag || (us->fflags & US_FL_BULK_IGNORE_TAG)) ||
1199 bcs->Status > US_BULK_STAT_PHASE) {
1200 usb_stor_dbg(us, "Bulk logical error\n");
1201 return USB_STOR_TRANSPORT_ERROR;
1202 }
1203
1204
1205
1206
1207
1208 if (!us->bcs_signature) {
1209 us->bcs_signature = bcs->Signature;
1210 if (us->bcs_signature != cpu_to_le32(US_BULK_CS_SIGN))
1211 usb_stor_dbg(us, "Learnt BCS signature 0x%08X\n",
1212 le32_to_cpu(us->bcs_signature));
1213 } else if (bcs->Signature != us->bcs_signature) {
1214 usb_stor_dbg(us, "Signature mismatch: got %08X, expecting %08X\n",
1215 le32_to_cpu(bcs->Signature),
1216 le32_to_cpu(us->bcs_signature));
1217 return USB_STOR_TRANSPORT_ERROR;
1218 }
1219
1220
1221
1222 if (residue && !(us->fflags & US_FL_IGNORE_RESIDUE)) {
1223
1224
1225
1226
1227
1228 if (bcs->Status == US_BULK_STAT_OK &&
1229 scsi_get_resid(srb) == 0 &&
1230 ((srb->cmnd[0] == INQUIRY &&
1231 transfer_length == 36) ||
1232 (srb->cmnd[0] == READ_CAPACITY &&
1233 transfer_length == 8))) {
1234 us->fflags |= US_FL_IGNORE_RESIDUE;
1235
1236 } else {
1237 residue = min(residue, transfer_length);
1238 scsi_set_resid(srb, max(scsi_get_resid(srb),
1239 (int) residue));
1240 }
1241 }
1242
1243
1244 switch (bcs->Status) {
1245 case US_BULK_STAT_OK:
1246
1247 if (fake_sense) {
1248 memcpy(srb->sense_buffer,
1249 usb_stor_sense_invalidCDB,
1250 sizeof(usb_stor_sense_invalidCDB));
1251 return USB_STOR_TRANSPORT_NO_SENSE;
1252 }
1253
1254
1255 return USB_STOR_TRANSPORT_GOOD;
1256
1257 case US_BULK_STAT_FAIL:
1258
1259 return USB_STOR_TRANSPORT_FAILED;
1260
1261 case US_BULK_STAT_PHASE:
1262
1263
1264
1265 return USB_STOR_TRANSPORT_ERROR;
1266 }
1267
1268
1269 return USB_STOR_TRANSPORT_ERROR;
1270}
1271EXPORT_SYMBOL_GPL(usb_stor_Bulk_transport);
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285static int usb_stor_reset_common(struct us_data *us,
1286 u8 request, u8 requesttype,
1287 u16 value, u16 index, void *data, u16 size)
1288{
1289 int result;
1290 int result2;
1291
1292 if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1293 usb_stor_dbg(us, "No reset during disconnect\n");
1294 return -EIO;
1295 }
1296
1297 result = usb_stor_control_msg(us, us->send_ctrl_pipe,
1298 request, requesttype, value, index, data, size,
1299 5*HZ);
1300 if (result < 0) {
1301 usb_stor_dbg(us, "Soft reset failed: %d\n", result);
1302 return result;
1303 }
1304
1305
1306
1307 wait_event_interruptible_timeout(us->delay_wait,
1308 test_bit(US_FLIDX_DISCONNECTING, &us->dflags),
1309 HZ*6);
1310 if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1311 usb_stor_dbg(us, "Reset interrupted by disconnect\n");
1312 return -EIO;
1313 }
1314
1315 usb_stor_dbg(us, "Soft reset: clearing bulk-in endpoint halt\n");
1316 result = usb_stor_clear_halt(us, us->recv_bulk_pipe);
1317
1318 usb_stor_dbg(us, "Soft reset: clearing bulk-out endpoint halt\n");
1319 result2 = usb_stor_clear_halt(us, us->send_bulk_pipe);
1320
1321
1322 if (result >= 0)
1323 result = result2;
1324 if (result < 0)
1325 usb_stor_dbg(us, "Soft reset failed\n");
1326 else
1327 usb_stor_dbg(us, "Soft reset done\n");
1328 return result;
1329}
1330
1331
1332
1333#define CB_RESET_CMD_SIZE 12
1334
1335int usb_stor_CB_reset(struct us_data *us)
1336{
1337 memset(us->iobuf, 0xFF, CB_RESET_CMD_SIZE);
1338 us->iobuf[0] = SEND_DIAGNOSTIC;
1339 us->iobuf[1] = 4;
1340 return usb_stor_reset_common(us, US_CBI_ADSC,
1341 USB_TYPE_CLASS | USB_RECIP_INTERFACE,
1342 0, us->ifnum, us->iobuf, CB_RESET_CMD_SIZE);
1343}
1344EXPORT_SYMBOL_GPL(usb_stor_CB_reset);
1345
1346
1347
1348
1349int usb_stor_Bulk_reset(struct us_data *us)
1350{
1351 return usb_stor_reset_common(us, US_BULK_RESET_REQUEST,
1352 USB_TYPE_CLASS | USB_RECIP_INTERFACE,
1353 0, us->ifnum, NULL, 0);
1354}
1355EXPORT_SYMBOL_GPL(usb_stor_Bulk_reset);
1356
1357
1358
1359
1360int usb_stor_port_reset(struct us_data *us)
1361{
1362 int result;
1363
1364
1365 if (us->pusb_dev->quirks & USB_QUIRK_RESET)
1366 return -EPERM;
1367
1368 result = usb_lock_device_for_reset(us->pusb_dev, us->pusb_intf);
1369 if (result < 0)
1370 usb_stor_dbg(us, "unable to lock device for reset: %d\n",
1371 result);
1372 else {
1373
1374 if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1375 result = -EIO;
1376 usb_stor_dbg(us, "No reset during disconnect\n");
1377 } else {
1378 result = usb_reset_device(us->pusb_dev);
1379 usb_stor_dbg(us, "usb_reset_device returns %d\n",
1380 result);
1381 }
1382 usb_unlock_device(us->pusb_dev);
1383 }
1384 return result;
1385}
1386