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