• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Driver for USB Mass Storage compliant devices
4  *
5  * Current development and maintenance by:
6  *   (c) 1999-2002 Matthew Dharm (mdharm-usb@one-eyed-alien.net)
7  *
8  * Developed with the assistance of:
9  *   (c) 2000 David L. Brown, Jr. (usb-storage@davidb.org)
10  *   (c) 2000 Stephen J. Gowdy (SGowdy@lbl.gov)
11  *   (c) 2002 Alan Stern <stern@rowland.org>
12  *
13  * Initial work by:
14  *   (c) 1999 Michael Gee (michael@linuxspecific.com)
15  *
16  * This driver is based on the 'USB Mass Storage Class' document. This
17  * describes in detail the protocol used to communicate with such
18  * devices.  Clearly, the designers had SCSI and ATAPI commands in
19  * mind when they created this document.  The commands are all very
20  * similar to commands in the SCSI-II and ATAPI specifications.
21  *
22  * It is important to note that in a number of cases this class
23  * exhibits class-specific exemptions from the USB specification.
24  * Notably the usage of NAK, STALL and ACK differs from the norm, in
25  * that they are used to communicate wait, failed and OK on commands.
26  *
27  * Also, for certain devices, the interrupt endpoint is used to convey
28  * status of a command.
29  */
30 
31 #include <linux/sched.h>
32 #include <linux/gfp.h>
33 #include <linux/errno.h>
34 #include <linux/export.h>
35 
36 #include <linux/usb/quirks.h>
37 
38 #include <scsi/scsi.h>
39 #include <scsi/scsi_eh.h>
40 #include <scsi/scsi_device.h>
41 
42 #include "usb.h"
43 #include "transport.h"
44 #include "protocol.h"
45 #include "scsiglue.h"
46 #include "debug.h"
47 
48 #include <linux/blkdev.h>
49 #include "../../scsi/sd.h"
50 
51 
52 /***********************************************************************
53  * Data transfer routines
54  ***********************************************************************/
55 
56 /*
57  * This is subtle, so pay attention:
58  * ---------------------------------
59  * We're very concerned about races with a command abort.  Hanging this code
60  * is a sure fire way to hang the kernel.  (Note that this discussion applies
61  * only to transactions resulting from a scsi queued-command, since only
62  * these transactions are subject to a scsi abort.  Other transactions, such
63  * as those occurring during device-specific initialization, must be handled
64  * by a separate code path.)
65  *
66  * The abort function (usb_storage_command_abort() in scsiglue.c) first
67  * sets the machine state and the ABORTING bit in us->dflags to prevent
68  * new URBs from being submitted.  It then calls usb_stor_stop_transport()
69  * below, which atomically tests-and-clears the URB_ACTIVE bit in us->dflags
70  * to see if the current_urb needs to be stopped.  Likewise, the SG_ACTIVE
71  * bit is tested to see if the current_sg scatter-gather request needs to be
72  * stopped.  The timeout callback routine does much the same thing.
73  *
74  * When a disconnect occurs, the DISCONNECTING bit in us->dflags is set to
75  * prevent new URBs from being submitted, and usb_stor_stop_transport() is
76  * called to stop any ongoing requests.
77  *
78  * The submit function first verifies that the submitting is allowed
79  * (neither ABORTING nor DISCONNECTING bits are set) and that the submit
80  * completes without errors, and only then sets the URB_ACTIVE bit.  This
81  * prevents the stop_transport() function from trying to cancel the URB
82  * while the submit call is underway.  Next, the submit function must test
83  * the flags to see if an abort or disconnect occurred during the submission
84  * or before the URB_ACTIVE bit was set.  If so, it's essential to cancel
85  * the URB if it hasn't been cancelled already (i.e., if the URB_ACTIVE bit
86  * is still set).  Either way, the function must then wait for the URB to
87  * finish.  Note that the URB can still be in progress even after a call to
88  * usb_unlink_urb() returns.
89  *
90  * The idea is that (1) once the ABORTING or DISCONNECTING bit is set,
91  * either the stop_transport() function or the submitting function
92  * is guaranteed to call usb_unlink_urb() for an active URB,
93  * and (2) test_and_clear_bit() prevents usb_unlink_urb() from being
94  * called more than once or from being called during usb_submit_urb().
95  */
96 
97 /*
98  * This is the completion handler which will wake us up when an URB
99  * completes.
100  */
usb_stor_blocking_completion(struct urb * urb)101 static void usb_stor_blocking_completion(struct urb *urb)
102 {
103 	struct completion *urb_done_ptr = urb->context;
104 
105 	complete(urb_done_ptr);
106 }
107 
108 /*
109  * This is the common part of the URB message submission code
110  *
111  * All URBs from the usb-storage driver involved in handling a queued scsi
112  * command _must_ pass through this function (or something like it) for the
113  * abort mechanisms to work properly.
114  */
usb_stor_msg_common(struct us_data * us,int timeout)115 static int usb_stor_msg_common(struct us_data *us, int timeout)
116 {
117 	struct completion urb_done;
118 	long timeleft;
119 	int status;
120 
121 	/* don't submit URBs during abort processing */
122 	if (test_bit(US_FLIDX_ABORTING, &us->dflags))
123 		return -EIO;
124 
125 	/* set up data structures for the wakeup system */
126 	init_completion(&urb_done);
127 
128 	/* fill the common fields in the URB */
129 	us->current_urb->context = &urb_done;
130 	us->current_urb->transfer_flags = 0;
131 
132 	/*
133 	 * we assume that if transfer_buffer isn't us->iobuf then it
134 	 * hasn't been mapped for DMA.  Yes, this is clunky, but it's
135 	 * easier than always having the caller tell us whether the
136 	 * transfer buffer has already been mapped.
137 	 */
138 	if (us->current_urb->transfer_buffer == us->iobuf)
139 		us->current_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
140 	us->current_urb->transfer_dma = us->iobuf_dma;
141 
142 	/* submit the URB */
143 	status = usb_submit_urb(us->current_urb, GFP_NOIO);
144 	if (status) {
145 		/* something went wrong */
146 		return status;
147 	}
148 
149 	/*
150 	 * since the URB has been submitted successfully, it's now okay
151 	 * to cancel it
152 	 */
153 	set_bit(US_FLIDX_URB_ACTIVE, &us->dflags);
154 
155 	/* did an abort occur during the submission? */
156 	if (test_bit(US_FLIDX_ABORTING, &us->dflags)) {
157 
158 		/* cancel the URB, if it hasn't been cancelled already */
159 		if (test_and_clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags)) {
160 			usb_stor_dbg(us, "-- cancelling URB\n");
161 			usb_unlink_urb(us->current_urb);
162 		}
163 	}
164 
165 	/* wait for the completion of the URB */
166 	timeleft = wait_for_completion_interruptible_timeout(
167 			&urb_done, timeout ? : MAX_SCHEDULE_TIMEOUT);
168 
169 	clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags);
170 
171 	if (timeleft <= 0) {
172 		usb_stor_dbg(us, "%s -- cancelling URB\n",
173 			     timeleft == 0 ? "Timeout" : "Signal");
174 		usb_kill_urb(us->current_urb);
175 	}
176 
177 	/* return the URB status */
178 	return us->current_urb->status;
179 }
180 
181 /*
182  * Transfer one control message, with timeouts, and allowing early
183  * termination.  Return codes are usual -Exxx, *not* USB_STOR_XFER_xxx.
184  */
usb_stor_control_msg(struct us_data * us,unsigned int pipe,u8 request,u8 requesttype,u16 value,u16 index,void * data,u16 size,int timeout)185 int usb_stor_control_msg(struct us_data *us, unsigned int pipe,
186 		 u8 request, u8 requesttype, u16 value, u16 index,
187 		 void *data, u16 size, int timeout)
188 {
189 	int status;
190 
191 	usb_stor_dbg(us, "rq=%02x rqtype=%02x value=%04x index=%02x len=%u\n",
192 		     request, requesttype, value, index, size);
193 
194 	/* fill in the devrequest structure */
195 	us->cr->bRequestType = requesttype;
196 	us->cr->bRequest = request;
197 	us->cr->wValue = cpu_to_le16(value);
198 	us->cr->wIndex = cpu_to_le16(index);
199 	us->cr->wLength = cpu_to_le16(size);
200 
201 	/* fill and submit the URB */
202 	usb_fill_control_urb(us->current_urb, us->pusb_dev, pipe,
203 			 (unsigned char*) us->cr, data, size,
204 			 usb_stor_blocking_completion, NULL);
205 	status = usb_stor_msg_common(us, timeout);
206 
207 	/* return the actual length of the data transferred if no error */
208 	if (status == 0)
209 		status = us->current_urb->actual_length;
210 	return status;
211 }
212 EXPORT_SYMBOL_GPL(usb_stor_control_msg);
213 
214 /*
215  * This is a version of usb_clear_halt() that allows early termination and
216  * doesn't read the status from the device -- this is because some devices
217  * crash their internal firmware when the status is requested after a halt.
218  *
219  * A definitive list of these 'bad' devices is too difficult to maintain or
220  * make complete enough to be useful.  This problem was first observed on the
221  * Hagiwara FlashGate DUAL unit.  However, bus traces reveal that neither
222  * MacOS nor Windows checks the status after clearing a halt.
223  *
224  * Since many vendors in this space limit their testing to interoperability
225  * with these two OSes, specification violations like this one are common.
226  */
usb_stor_clear_halt(struct us_data * us,unsigned int pipe)227 int usb_stor_clear_halt(struct us_data *us, unsigned int pipe)
228 {
229 	int result;
230 	int endp = usb_pipeendpoint(pipe);
231 
232 	if (usb_pipein (pipe))
233 		endp |= USB_DIR_IN;
234 
235 	result = usb_stor_control_msg(us, us->send_ctrl_pipe,
236 		USB_REQ_CLEAR_FEATURE, USB_RECIP_ENDPOINT,
237 		USB_ENDPOINT_HALT, endp,
238 		NULL, 0, 3*HZ);
239 
240 	if (result >= 0)
241 		usb_reset_endpoint(us->pusb_dev, endp);
242 
243 	usb_stor_dbg(us, "result = %d\n", result);
244 	return result;
245 }
246 EXPORT_SYMBOL_GPL(usb_stor_clear_halt);
247 
248 
249 /*
250  * Interpret the results of a URB transfer
251  *
252  * This function prints appropriate debugging messages, clears halts on
253  * non-control endpoints, and translates the status to the corresponding
254  * USB_STOR_XFER_xxx return code.
255  */
interpret_urb_result(struct us_data * us,unsigned int pipe,unsigned int length,int result,unsigned int partial)256 static int interpret_urb_result(struct us_data *us, unsigned int pipe,
257 		unsigned int length, int result, unsigned int partial)
258 {
259 	usb_stor_dbg(us, "Status code %d; transferred %u/%u\n",
260 		     result, partial, length);
261 	switch (result) {
262 
263 	/* no error code; did we send all the data? */
264 	case 0:
265 		if (partial != length) {
266 			usb_stor_dbg(us, "-- short transfer\n");
267 			return USB_STOR_XFER_SHORT;
268 		}
269 
270 		usb_stor_dbg(us, "-- transfer complete\n");
271 		return USB_STOR_XFER_GOOD;
272 
273 	/* stalled */
274 	case -EPIPE:
275 		/*
276 		 * for control endpoints, (used by CB[I]) a stall indicates
277 		 * a failed command
278 		 */
279 		if (usb_pipecontrol(pipe)) {
280 			usb_stor_dbg(us, "-- stall on control pipe\n");
281 			return USB_STOR_XFER_STALLED;
282 		}
283 
284 		/* for other sorts of endpoint, clear the stall */
285 		usb_stor_dbg(us, "clearing endpoint halt for pipe 0x%x\n",
286 			     pipe);
287 		if (usb_stor_clear_halt(us, pipe) < 0)
288 			return USB_STOR_XFER_ERROR;
289 		return USB_STOR_XFER_STALLED;
290 
291 	/* babble - the device tried to send more than we wanted to read */
292 	case -EOVERFLOW:
293 		usb_stor_dbg(us, "-- babble\n");
294 		return USB_STOR_XFER_LONG;
295 
296 	/* the transfer was cancelled by abort, disconnect, or timeout */
297 	case -ECONNRESET:
298 		usb_stor_dbg(us, "-- transfer cancelled\n");
299 		return USB_STOR_XFER_ERROR;
300 
301 	/* short scatter-gather read transfer */
302 	case -EREMOTEIO:
303 		usb_stor_dbg(us, "-- short read transfer\n");
304 		return USB_STOR_XFER_SHORT;
305 
306 	/* abort or disconnect in progress */
307 	case -EIO:
308 		usb_stor_dbg(us, "-- abort or disconnect in progress\n");
309 		return USB_STOR_XFER_ERROR;
310 
311 	/* the catch-all error case */
312 	default:
313 		usb_stor_dbg(us, "-- unknown error\n");
314 		return USB_STOR_XFER_ERROR;
315 	}
316 }
317 
318 /*
319  * Transfer one control message, without timeouts, but allowing early
320  * termination.  Return codes are USB_STOR_XFER_xxx.
321  */
usb_stor_ctrl_transfer(struct us_data * us,unsigned int pipe,u8 request,u8 requesttype,u16 value,u16 index,void * data,u16 size)322 int usb_stor_ctrl_transfer(struct us_data *us, unsigned int pipe,
323 		u8 request, u8 requesttype, u16 value, u16 index,
324 		void *data, u16 size)
325 {
326 	int result;
327 
328 	usb_stor_dbg(us, "rq=%02x rqtype=%02x value=%04x index=%02x len=%u\n",
329 		     request, requesttype, value, index, size);
330 
331 	/* fill in the devrequest structure */
332 	us->cr->bRequestType = requesttype;
333 	us->cr->bRequest = request;
334 	us->cr->wValue = cpu_to_le16(value);
335 	us->cr->wIndex = cpu_to_le16(index);
336 	us->cr->wLength = cpu_to_le16(size);
337 
338 	/* fill and submit the URB */
339 	usb_fill_control_urb(us->current_urb, us->pusb_dev, pipe,
340 			 (unsigned char*) us->cr, data, size,
341 			 usb_stor_blocking_completion, NULL);
342 	result = usb_stor_msg_common(us, 0);
343 
344 	return interpret_urb_result(us, pipe, size, result,
345 			us->current_urb->actual_length);
346 }
347 EXPORT_SYMBOL_GPL(usb_stor_ctrl_transfer);
348 
349 /*
350  * Receive one interrupt buffer, without timeouts, but allowing early
351  * termination.  Return codes are USB_STOR_XFER_xxx.
352  *
353  * This routine always uses us->recv_intr_pipe as the pipe and
354  * us->ep_bInterval as the interrupt interval.
355  */
usb_stor_intr_transfer(struct us_data * us,void * buf,unsigned int length)356 static int usb_stor_intr_transfer(struct us_data *us, void *buf,
357 				  unsigned int length)
358 {
359 	int result;
360 	unsigned int pipe = us->recv_intr_pipe;
361 	unsigned int maxp;
362 
363 	usb_stor_dbg(us, "xfer %u bytes\n", length);
364 
365 	/* calculate the max packet size */
366 	maxp = usb_maxpacket(us->pusb_dev, pipe, usb_pipeout(pipe));
367 	if (maxp > length)
368 		maxp = length;
369 
370 	/* fill and submit the URB */
371 	usb_fill_int_urb(us->current_urb, us->pusb_dev, pipe, buf,
372 			maxp, usb_stor_blocking_completion, NULL,
373 			us->ep_bInterval);
374 	result = usb_stor_msg_common(us, 0);
375 
376 	return interpret_urb_result(us, pipe, length, result,
377 			us->current_urb->actual_length);
378 }
379 
380 /*
381  * Transfer one buffer via bulk pipe, without timeouts, but allowing early
382  * termination.  Return codes are USB_STOR_XFER_xxx.  If the bulk pipe
383  * stalls during the transfer, the halt is automatically cleared.
384  */
usb_stor_bulk_transfer_buf(struct us_data * us,unsigned int pipe,void * buf,unsigned int length,unsigned int * act_len)385 int usb_stor_bulk_transfer_buf(struct us_data *us, unsigned int pipe,
386 	void *buf, unsigned int length, unsigned int *act_len)
387 {
388 	int result;
389 
390 	usb_stor_dbg(us, "xfer %u bytes\n", length);
391 
392 	/* fill and submit the URB */
393 	usb_fill_bulk_urb(us->current_urb, us->pusb_dev, pipe, buf, length,
394 		      usb_stor_blocking_completion, NULL);
395 	result = usb_stor_msg_common(us, 0);
396 
397 	/* store the actual length of the data transferred */
398 	if (act_len)
399 		*act_len = us->current_urb->actual_length;
400 	return interpret_urb_result(us, pipe, length, result,
401 			us->current_urb->actual_length);
402 }
403 EXPORT_SYMBOL_GPL(usb_stor_bulk_transfer_buf);
404 
405 /*
406  * Transfer a scatter-gather list via bulk transfer
407  *
408  * This function does basically the same thing as usb_stor_bulk_transfer_buf()
409  * above, but it uses the usbcore scatter-gather library.
410  */
usb_stor_bulk_transfer_sglist(struct us_data * us,unsigned int pipe,struct scatterlist * sg,int num_sg,unsigned int length,unsigned int * act_len)411 static int usb_stor_bulk_transfer_sglist(struct us_data *us, unsigned int pipe,
412 		struct scatterlist *sg, int num_sg, unsigned int length,
413 		unsigned int *act_len)
414 {
415 	int result;
416 
417 	/* don't submit s-g requests during abort processing */
418 	if (test_bit(US_FLIDX_ABORTING, &us->dflags))
419 		return USB_STOR_XFER_ERROR;
420 
421 	/* initialize the scatter-gather request block */
422 	usb_stor_dbg(us, "xfer %u bytes, %d entries\n", length, num_sg);
423 	result = usb_sg_init(&us->current_sg, us->pusb_dev, pipe, 0,
424 			sg, num_sg, length, GFP_NOIO);
425 	if (result) {
426 		usb_stor_dbg(us, "usb_sg_init returned %d\n", result);
427 		return USB_STOR_XFER_ERROR;
428 	}
429 
430 	/*
431 	 * since the block has been initialized successfully, it's now
432 	 * okay to cancel it
433 	 */
434 	set_bit(US_FLIDX_SG_ACTIVE, &us->dflags);
435 
436 	/* did an abort occur during the submission? */
437 	if (test_bit(US_FLIDX_ABORTING, &us->dflags)) {
438 
439 		/* cancel the request, if it hasn't been cancelled already */
440 		if (test_and_clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags)) {
441 			usb_stor_dbg(us, "-- cancelling sg request\n");
442 			usb_sg_cancel(&us->current_sg);
443 		}
444 	}
445 
446 	/* wait for the completion of the transfer */
447 	usb_sg_wait(&us->current_sg);
448 	clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags);
449 
450 	result = us->current_sg.status;
451 	if (act_len)
452 		*act_len = us->current_sg.bytes;
453 	return interpret_urb_result(us, pipe, length, result,
454 			us->current_sg.bytes);
455 }
456 
457 /*
458  * Common used function. Transfer a complete command
459  * via usb_stor_bulk_transfer_sglist() above. Set cmnd resid
460  */
usb_stor_bulk_srb(struct us_data * us,unsigned int pipe,struct scsi_cmnd * srb)461 int usb_stor_bulk_srb(struct us_data* us, unsigned int pipe,
462 		      struct scsi_cmnd* srb)
463 {
464 	unsigned int partial;
465 	int result = usb_stor_bulk_transfer_sglist(us, pipe, scsi_sglist(srb),
466 				      scsi_sg_count(srb), scsi_bufflen(srb),
467 				      &partial);
468 
469 	scsi_set_resid(srb, scsi_bufflen(srb) - partial);
470 	return result;
471 }
472 EXPORT_SYMBOL_GPL(usb_stor_bulk_srb);
473 
474 /*
475  * Transfer an entire SCSI command's worth of data payload over the bulk
476  * pipe.
477  *
478  * Note that this uses usb_stor_bulk_transfer_buf() and
479  * usb_stor_bulk_transfer_sglist() to achieve its goals --
480  * this function simply determines whether we're going to use
481  * scatter-gather or not, and acts appropriately.
482  */
usb_stor_bulk_transfer_sg(struct us_data * us,unsigned int pipe,void * buf,unsigned int length_left,int use_sg,int * residual)483 int usb_stor_bulk_transfer_sg(struct us_data* us, unsigned int pipe,
484 		void *buf, unsigned int length_left, int use_sg, int *residual)
485 {
486 	int result;
487 	unsigned int partial;
488 
489 	/* are we scatter-gathering? */
490 	if (use_sg) {
491 		/* use the usb core scatter-gather primitives */
492 		result = usb_stor_bulk_transfer_sglist(us, pipe,
493 				(struct scatterlist *) buf, use_sg,
494 				length_left, &partial);
495 		length_left -= partial;
496 	} else {
497 		/* no scatter-gather, just make the request */
498 		result = usb_stor_bulk_transfer_buf(us, pipe, buf,
499 				length_left, &partial);
500 		length_left -= partial;
501 	}
502 
503 	/* store the residual and return the error code */
504 	if (residual)
505 		*residual = length_left;
506 	return result;
507 }
508 EXPORT_SYMBOL_GPL(usb_stor_bulk_transfer_sg);
509 
510 /***********************************************************************
511  * Transport routines
512  ***********************************************************************/
513 
514 /*
515  * There are so many devices that report the capacity incorrectly,
516  * this routine was written to counteract some of the resulting
517  * problems.
518  */
last_sector_hacks(struct us_data * us,struct scsi_cmnd * srb)519 static void last_sector_hacks(struct us_data *us, struct scsi_cmnd *srb)
520 {
521 	struct gendisk *disk;
522 	struct scsi_disk *sdkp;
523 	u32 sector;
524 
525 	/* To Report "Medium Error: Record Not Found */
526 	static unsigned char record_not_found[18] = {
527 		[0]	= 0x70,			/* current error */
528 		[2]	= MEDIUM_ERROR,		/* = 0x03 */
529 		[7]	= 0x0a,			/* additional length */
530 		[12]	= 0x14			/* Record Not Found */
531 	};
532 
533 	/*
534 	 * If last-sector problems can't occur, whether because the
535 	 * capacity was already decremented or because the device is
536 	 * known to report the correct capacity, then we don't need
537 	 * to do anything.
538 	 */
539 	if (!us->use_last_sector_hacks)
540 		return;
541 
542 	/* Was this command a READ(10) or a WRITE(10)? */
543 	if (srb->cmnd[0] != READ_10 && srb->cmnd[0] != WRITE_10)
544 		goto done;
545 
546 	/* Did this command access the last sector? */
547 	sector = (srb->cmnd[2] << 24) | (srb->cmnd[3] << 16) |
548 			(srb->cmnd[4] << 8) | (srb->cmnd[5]);
549 	disk = srb->request->rq_disk;
550 	if (!disk)
551 		goto done;
552 	sdkp = scsi_disk(disk);
553 	if (!sdkp)
554 		goto done;
555 	if (sector + 1 != sdkp->capacity)
556 		goto done;
557 
558 	if (srb->result == SAM_STAT_GOOD && scsi_get_resid(srb) == 0) {
559 
560 		/*
561 		 * The command succeeded.  We know this device doesn't
562 		 * have the last-sector bug, so stop checking it.
563 		 */
564 		us->use_last_sector_hacks = 0;
565 
566 	} else {
567 		/*
568 		 * The command failed.  Allow up to 3 retries in case this
569 		 * is some normal sort of failure.  After that, assume the
570 		 * capacity is wrong and we're trying to access the sector
571 		 * beyond the end.  Replace the result code and sense data
572 		 * with values that will cause the SCSI core to fail the
573 		 * command immediately, instead of going into an infinite
574 		 * (or even just a very long) retry loop.
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 	 * Don't reset the retry counter for TEST UNIT READY commands,
586 	 * because they get issued after device resets which might be
587 	 * caused by a failed last-sector access.
588 	 */
589 	if (srb->cmnd[0] != TEST_UNIT_READY)
590 		us->last_sector_retries = 0;
591 }
592 
593 /*
594  * Invoke the transport and basic error-handling/recovery methods
595  *
596  * This is used by the protocol layers to actually send the message to
597  * the device and receive the response.
598  */
usb_stor_invoke_transport(struct scsi_cmnd * srb,struct us_data * us)599 void usb_stor_invoke_transport(struct scsi_cmnd *srb, struct us_data *us)
600 {
601 	int need_auto_sense;
602 	int result;
603 
604 	/* send the command to the transport layer */
605 	scsi_set_resid(srb, 0);
606 	result = us->transport(srb, us);
607 
608 	/*
609 	 * if the command gets aborted by the higher layers, we need to
610 	 * short-circuit all other processing
611 	 */
612 	if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
613 		usb_stor_dbg(us, "-- command was aborted\n");
614 		srb->result = DID_ABORT << 16;
615 		goto Handle_Errors;
616 	}
617 
618 	/* if there is a transport error, reset and don't auto-sense */
619 	if (result == USB_STOR_TRANSPORT_ERROR) {
620 		usb_stor_dbg(us, "-- transport indicates error, resetting\n");
621 		srb->result = DID_ERROR << 16;
622 		goto Handle_Errors;
623 	}
624 
625 	/* if the transport provided its own sense data, don't auto-sense */
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 	 * Determine if we need to auto-sense
636 	 *
637 	 * I normally don't use a flag like this, but it's almost impossible
638 	 * to understand what's going on here if I don't.
639 	 */
640 	need_auto_sense = 0;
641 
642 	/*
643 	 * If we're running the CB transport, which is incapable
644 	 * of determining status on its own, we will auto-sense
645 	 * unless the operation involved a data-in transfer.  Devices
646 	 * can signal most data-in errors by stalling the bulk-in pipe.
647 	 */
648 	if ((us->protocol == USB_PR_CB || us->protocol == USB_PR_DPCM_USB) &&
649 			srb->sc_data_direction != DMA_FROM_DEVICE) {
650 		usb_stor_dbg(us, "-- CB transport device requiring auto-sense\n");
651 		need_auto_sense = 1;
652 	}
653 
654 	/* Some devices (Kindle) require another command after SYNC CACHE */
655 	if ((us->fflags & US_FL_SENSE_AFTER_SYNC) &&
656 			srb->cmnd[0] == SYNCHRONIZE_CACHE) {
657 		usb_stor_dbg(us, "-- sense after SYNC CACHE\n");
658 		need_auto_sense = 1;
659 	}
660 
661 	/*
662 	 * If we have a failure, we're going to do a REQUEST_SENSE
663 	 * automatically.  Note that we differentiate between a command
664 	 * "failure" and an "error" in the transport mechanism.
665 	 */
666 	if (result == USB_STOR_TRANSPORT_FAILED) {
667 		usb_stor_dbg(us, "-- transport indicates command failure\n");
668 		need_auto_sense = 1;
669 	}
670 
671 	/*
672 	 * Determine if this device is SAT by seeing if the
673 	 * command executed successfully.  Otherwise we'll have
674 	 * to wait for at least one CHECK_CONDITION to determine
675 	 * SANE_SENSE support
676 	 */
677 	if (unlikely((srb->cmnd[0] == ATA_16 || srb->cmnd[0] == ATA_12) &&
678 	    result == USB_STOR_TRANSPORT_GOOD &&
679 	    !(us->fflags & US_FL_SANE_SENSE) &&
680 	    !(us->fflags & US_FL_BAD_SENSE) &&
681 	    !(srb->cmnd[2] & 0x20))) {
682 		usb_stor_dbg(us, "-- SAT supported, increasing auto-sense\n");
683 		us->fflags |= US_FL_SANE_SENSE;
684 	}
685 
686 	/*
687 	 * A short transfer on a command where we don't expect it
688 	 * is unusual, but it doesn't mean we need to auto-sense.
689 	 */
690 	if ((scsi_get_resid(srb) > 0) &&
691 	    !((srb->cmnd[0] == REQUEST_SENSE) ||
692 	      (srb->cmnd[0] == INQUIRY) ||
693 	      (srb->cmnd[0] == MODE_SENSE) ||
694 	      (srb->cmnd[0] == LOG_SENSE) ||
695 	      (srb->cmnd[0] == MODE_SENSE_10))) {
696 		usb_stor_dbg(us, "-- unexpectedly short transfer\n");
697 	}
698 
699 	/* Now, if we need to do the auto-sense, let's do it */
700 	if (need_auto_sense) {
701 		int temp_result;
702 		struct scsi_eh_save ses;
703 		int sense_size = US_SENSE_SIZE;
704 		struct scsi_sense_hdr sshdr;
705 		const u8 *scdd;
706 		u8 fm_ili;
707 
708 		/* device supports and needs bigger sense buffer */
709 		if (us->fflags & US_FL_SANE_SENSE)
710 			sense_size = ~0;
711 Retry_Sense:
712 		usb_stor_dbg(us, "Issuing auto-REQUEST_SENSE\n");
713 
714 		scsi_eh_prep_cmnd(srb, &ses, NULL, 0, sense_size);
715 
716 		/* FIXME: we must do the protocol translation here */
717 		if (us->subclass == USB_SC_RBC || us->subclass == USB_SC_SCSI ||
718 				us->subclass == USB_SC_CYP_ATACB)
719 			srb->cmd_len = 6;
720 		else
721 			srb->cmd_len = 12;
722 
723 		/* issue the auto-sense command */
724 		scsi_set_resid(srb, 0);
725 		temp_result = us->transport(us->srb, us);
726 
727 		/* let's clean up right away */
728 		scsi_eh_restore_cmnd(srb, &ses);
729 
730 		if (test_bit(US_FLIDX_TIMED_OUT, &us->dflags)) {
731 			usb_stor_dbg(us, "-- auto-sense aborted\n");
732 			srb->result = DID_ABORT << 16;
733 
734 			/* If SANE_SENSE caused this problem, disable it */
735 			if (sense_size != US_SENSE_SIZE) {
736 				us->fflags &= ~US_FL_SANE_SENSE;
737 				us->fflags |= US_FL_BAD_SENSE;
738 			}
739 			goto Handle_Errors;
740 		}
741 
742 		/*
743 		 * Some devices claim to support larger sense but fail when
744 		 * trying to request it. When a transport failure happens
745 		 * using US_FS_SANE_SENSE, we always retry with a standard
746 		 * (small) sense request. This fixes some USB GSM modems
747 		 */
748 		if (temp_result == USB_STOR_TRANSPORT_FAILED &&
749 				sense_size != US_SENSE_SIZE) {
750 			usb_stor_dbg(us, "-- auto-sense failure, retry small sense\n");
751 			sense_size = US_SENSE_SIZE;
752 			us->fflags &= ~US_FL_SANE_SENSE;
753 			us->fflags |= US_FL_BAD_SENSE;
754 			goto Retry_Sense;
755 		}
756 
757 		/* Other failures */
758 		if (temp_result != USB_STOR_TRANSPORT_GOOD) {
759 			usb_stor_dbg(us, "-- auto-sense failure\n");
760 
761 			/*
762 			 * we skip the reset if this happens to be a
763 			 * multi-target device, since failure of an
764 			 * auto-sense is perfectly valid
765 			 */
766 			srb->result = DID_ERROR << 16;
767 			if (!(us->fflags & US_FL_SCM_MULT_TARG))
768 				goto Handle_Errors;
769 			return;
770 		}
771 
772 		/*
773 		 * If the sense data returned is larger than 18-bytes then we
774 		 * assume this device supports requesting more in the future.
775 		 * The response code must be 70h through 73h inclusive.
776 		 */
777 		if (srb->sense_buffer[7] > (US_SENSE_SIZE - 8) &&
778 		    !(us->fflags & US_FL_SANE_SENSE) &&
779 		    !(us->fflags & US_FL_BAD_SENSE) &&
780 		    (srb->sense_buffer[0] & 0x7C) == 0x70) {
781 			usb_stor_dbg(us, "-- SANE_SENSE support enabled\n");
782 			us->fflags |= US_FL_SANE_SENSE;
783 
784 			/*
785 			 * Indicate to the user that we truncated their sense
786 			 * because we didn't know it supported larger sense.
787 			 */
788 			usb_stor_dbg(us, "-- Sense data truncated to %i from %i\n",
789 				     US_SENSE_SIZE,
790 				     srb->sense_buffer[7] + 8);
791 			srb->sense_buffer[7] = (US_SENSE_SIZE - 8);
792 		}
793 
794 		scsi_normalize_sense(srb->sense_buffer, SCSI_SENSE_BUFFERSIZE,
795 				     &sshdr);
796 
797 		usb_stor_dbg(us, "-- Result from auto-sense is %d\n",
798 			     temp_result);
799 		usb_stor_dbg(us, "-- code: 0x%x, key: 0x%x, ASC: 0x%x, ASCQ: 0x%x\n",
800 			     sshdr.response_code, sshdr.sense_key,
801 			     sshdr.asc, sshdr.ascq);
802 #ifdef CONFIG_USB_STORAGE_DEBUG
803 		usb_stor_show_sense(us, sshdr.sense_key, sshdr.asc, sshdr.ascq);
804 #endif
805 
806 		/* set the result so the higher layers expect this data */
807 		srb->result = SAM_STAT_CHECK_CONDITION;
808 
809 		scdd = scsi_sense_desc_find(srb->sense_buffer,
810 					    SCSI_SENSE_BUFFERSIZE, 4);
811 		fm_ili = (scdd ? scdd[3] : srb->sense_buffer[2]) & 0xA0;
812 
813 		/*
814 		 * We often get empty sense data.  This could indicate that
815 		 * everything worked or that there was an unspecified
816 		 * problem.  We have to decide which.
817 		 */
818 		if (sshdr.sense_key == 0 && sshdr.asc == 0 && sshdr.ascq == 0 &&
819 		    fm_ili == 0) {
820 			/*
821 			 * If things are really okay, then let's show that.
822 			 * Zero out the sense buffer so the higher layers
823 			 * won't realize we did an unsolicited auto-sense.
824 			 */
825 			if (result == USB_STOR_TRANSPORT_GOOD) {
826 				srb->result = SAM_STAT_GOOD;
827 				srb->sense_buffer[0] = 0x0;
828 			}
829 
830 			/*
831 			 * ATA-passthru commands use sense data to report
832 			 * the command completion status, and often devices
833 			 * return Check Condition status when nothing is
834 			 * wrong.
835 			 */
836 			else if (srb->cmnd[0] == ATA_16 ||
837 					srb->cmnd[0] == ATA_12) {
838 				/* leave the data alone */
839 			}
840 
841 			/*
842 			 * If there was a problem, report an unspecified
843 			 * hardware error to prevent the higher layers from
844 			 * entering an infinite retry loop.
845 			 */
846 			else {
847 				srb->result = DID_ERROR << 16;
848 				if ((sshdr.response_code & 0x72) == 0x72)
849 					srb->sense_buffer[1] = HARDWARE_ERROR;
850 				else
851 					srb->sense_buffer[2] = HARDWARE_ERROR;
852 			}
853 		}
854 	}
855 
856 	/*
857 	 * Some devices don't work or return incorrect data the first
858 	 * time they get a READ(10) command, or for the first READ(10)
859 	 * after a media change.  If the INITIAL_READ10 flag is set,
860 	 * keep track of whether READ(10) commands succeed.  If the
861 	 * previous one succeeded and this one failed, set the REDO_READ10
862 	 * flag to force a retry.
863 	 */
864 	if (unlikely((us->fflags & US_FL_INITIAL_READ10) &&
865 			srb->cmnd[0] == READ_10)) {
866 		if (srb->result == SAM_STAT_GOOD) {
867 			set_bit(US_FLIDX_READ10_WORKED, &us->dflags);
868 		} else if (test_bit(US_FLIDX_READ10_WORKED, &us->dflags)) {
869 			clear_bit(US_FLIDX_READ10_WORKED, &us->dflags);
870 			set_bit(US_FLIDX_REDO_READ10, &us->dflags);
871 		}
872 
873 		/*
874 		 * Next, if the REDO_READ10 flag is set, return a result
875 		 * code that will cause the SCSI core to retry the READ(10)
876 		 * command immediately.
877 		 */
878 		if (test_bit(US_FLIDX_REDO_READ10, &us->dflags)) {
879 			clear_bit(US_FLIDX_REDO_READ10, &us->dflags);
880 			srb->result = DID_IMM_RETRY << 16;
881 			srb->sense_buffer[0] = 0;
882 		}
883 	}
884 
885 	/* Did we transfer less than the minimum amount required? */
886 	if ((srb->result == SAM_STAT_GOOD || srb->sense_buffer[2] == 0) &&
887 			scsi_bufflen(srb) - scsi_get_resid(srb) < srb->underflow)
888 		srb->result = DID_ERROR << 16;
889 
890 	last_sector_hacks(us, srb);
891 	return;
892 
893 	/*
894 	 * Error and abort processing: try to resynchronize with the device
895 	 * by issuing a port reset.  If that fails, try a class-specific
896 	 * device reset.
897 	 */
898   Handle_Errors:
899 
900 	/*
901 	 * Set the RESETTING bit, and clear the ABORTING bit so that
902 	 * the reset may proceed.
903 	 */
904 	scsi_lock(us_to_host(us));
905 	set_bit(US_FLIDX_RESETTING, &us->dflags);
906 	clear_bit(US_FLIDX_ABORTING, &us->dflags);
907 	scsi_unlock(us_to_host(us));
908 
909 	/*
910 	 * We must release the device lock because the pre_reset routine
911 	 * will want to acquire it.
912 	 */
913 	mutex_unlock(&us->dev_mutex);
914 	result = usb_stor_port_reset(us);
915 	mutex_lock(&us->dev_mutex);
916 
917 	if (result < 0) {
918 		scsi_lock(us_to_host(us));
919 		usb_stor_report_device_reset(us);
920 		scsi_unlock(us_to_host(us));
921 		us->transport_reset(us);
922 	}
923 	clear_bit(US_FLIDX_RESETTING, &us->dflags);
924 	last_sector_hacks(us, srb);
925 }
926 
927 /* Stop the current URB transfer */
usb_stor_stop_transport(struct us_data * us)928 void usb_stor_stop_transport(struct us_data *us)
929 {
930 	/*
931 	 * If the state machine is blocked waiting for an URB,
932 	 * let's wake it up.  The test_and_clear_bit() call
933 	 * guarantees that if a URB has just been submitted,
934 	 * it won't be cancelled more than once.
935 	 */
936 	if (test_and_clear_bit(US_FLIDX_URB_ACTIVE, &us->dflags)) {
937 		usb_stor_dbg(us, "-- cancelling URB\n");
938 		usb_unlink_urb(us->current_urb);
939 	}
940 
941 	/* If we are waiting for a scatter-gather operation, cancel it. */
942 	if (test_and_clear_bit(US_FLIDX_SG_ACTIVE, &us->dflags)) {
943 		usb_stor_dbg(us, "-- cancelling sg request\n");
944 		usb_sg_cancel(&us->current_sg);
945 	}
946 }
947 
948 /*
949  * Control/Bulk and Control/Bulk/Interrupt transport
950  */
951 
usb_stor_CB_transport(struct scsi_cmnd * srb,struct us_data * us)952 int usb_stor_CB_transport(struct scsi_cmnd *srb, struct us_data *us)
953 {
954 	unsigned int transfer_length = scsi_bufflen(srb);
955 	unsigned int pipe = 0;
956 	int result;
957 
958 	/* COMMAND STAGE */
959 	/* let's send the command via the control pipe */
960 	/*
961 	 * Command is sometime (f.e. after scsi_eh_prep_cmnd) on the stack.
962 	 * Stack may be vmallocated.  So no DMA for us.  Make a copy.
963 	 */
964 	memcpy(us->iobuf, srb->cmnd, srb->cmd_len);
965 	result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
966 				      US_CBI_ADSC,
967 				      USB_TYPE_CLASS | USB_RECIP_INTERFACE, 0,
968 				      us->ifnum, us->iobuf, srb->cmd_len);
969 
970 	/* check the return code for the command */
971 	usb_stor_dbg(us, "Call to usb_stor_ctrl_transfer() returned %d\n",
972 		     result);
973 
974 	/* if we stalled the command, it means command failed */
975 	if (result == USB_STOR_XFER_STALLED) {
976 		return USB_STOR_TRANSPORT_FAILED;
977 	}
978 
979 	/* Uh oh... serious problem here */
980 	if (result != USB_STOR_XFER_GOOD) {
981 		return USB_STOR_TRANSPORT_ERROR;
982 	}
983 
984 	/* DATA STAGE */
985 	/* transfer the data payload for this command, if one exists*/
986 	if (transfer_length) {
987 		pipe = srb->sc_data_direction == DMA_FROM_DEVICE ?
988 				us->recv_bulk_pipe : us->send_bulk_pipe;
989 		result = usb_stor_bulk_srb(us, pipe, srb);
990 		usb_stor_dbg(us, "CBI data stage result is 0x%x\n", result);
991 
992 		/* if we stalled the data transfer it means command failed */
993 		if (result == USB_STOR_XFER_STALLED)
994 			return USB_STOR_TRANSPORT_FAILED;
995 		if (result > USB_STOR_XFER_STALLED)
996 			return USB_STOR_TRANSPORT_ERROR;
997 	}
998 
999 	/* STATUS STAGE */
1000 
1001 	/*
1002 	 * NOTE: CB does not have a status stage.  Silly, I know.  So
1003 	 * we have to catch this at a higher level.
1004 	 */
1005 	if (us->protocol != USB_PR_CBI)
1006 		return USB_STOR_TRANSPORT_GOOD;
1007 
1008 	result = usb_stor_intr_transfer(us, us->iobuf, 2);
1009 	usb_stor_dbg(us, "Got interrupt data (0x%x, 0x%x)\n",
1010 		     us->iobuf[0], us->iobuf[1]);
1011 	if (result != USB_STOR_XFER_GOOD)
1012 		return USB_STOR_TRANSPORT_ERROR;
1013 
1014 	/*
1015 	 * UFI gives us ASC and ASCQ, like a request sense
1016 	 *
1017 	 * REQUEST_SENSE and INQUIRY don't affect the sense data on UFI
1018 	 * devices, so we ignore the information for those commands.  Note
1019 	 * that this means we could be ignoring a real error on these
1020 	 * commands, but that can't be helped.
1021 	 */
1022 	if (us->subclass == USB_SC_UFI) {
1023 		if (srb->cmnd[0] == REQUEST_SENSE ||
1024 		    srb->cmnd[0] == INQUIRY)
1025 			return USB_STOR_TRANSPORT_GOOD;
1026 		if (us->iobuf[0])
1027 			goto Failed;
1028 		return USB_STOR_TRANSPORT_GOOD;
1029 	}
1030 
1031 	/*
1032 	 * If not UFI, we interpret the data as a result code
1033 	 * The first byte should always be a 0x0.
1034 	 *
1035 	 * Some bogus devices don't follow that rule.  They stuff the ASC
1036 	 * into the first byte -- so if it's non-zero, call it a failure.
1037 	 */
1038 	if (us->iobuf[0]) {
1039 		usb_stor_dbg(us, "CBI IRQ data showed reserved bType 0x%x\n",
1040 			     us->iobuf[0]);
1041 		goto Failed;
1042 
1043 	}
1044 
1045 	/* The second byte & 0x0F should be 0x0 for good, otherwise error */
1046 	switch (us->iobuf[1] & 0x0F) {
1047 		case 0x00:
1048 			return USB_STOR_TRANSPORT_GOOD;
1049 		case 0x01:
1050 			goto Failed;
1051 	}
1052 	return USB_STOR_TRANSPORT_ERROR;
1053 
1054 	/*
1055 	 * the CBI spec requires that the bulk pipe must be cleared
1056 	 * following any data-in/out command failure (section 2.4.3.1.3)
1057 	 */
1058   Failed:
1059 	if (pipe)
1060 		usb_stor_clear_halt(us, pipe);
1061 	return USB_STOR_TRANSPORT_FAILED;
1062 }
1063 EXPORT_SYMBOL_GPL(usb_stor_CB_transport);
1064 
1065 /*
1066  * Bulk only transport
1067  */
1068 
1069 /* Determine what the maximum LUN supported is */
usb_stor_Bulk_max_lun(struct us_data * us)1070 int usb_stor_Bulk_max_lun(struct us_data *us)
1071 {
1072 	int result;
1073 
1074 	/* issue the command */
1075 	us->iobuf[0] = 0;
1076 	result = usb_stor_control_msg(us, us->recv_ctrl_pipe,
1077 				 US_BULK_GET_MAX_LUN,
1078 				 USB_DIR_IN | USB_TYPE_CLASS |
1079 				 USB_RECIP_INTERFACE,
1080 				 0, us->ifnum, us->iobuf, 1, 10*HZ);
1081 
1082 	usb_stor_dbg(us, "GetMaxLUN command result is %d, data is %d\n",
1083 		     result, us->iobuf[0]);
1084 
1085 	/*
1086 	 * If we have a successful request, return the result if valid. The
1087 	 * CBW LUN field is 4 bits wide, so the value reported by the device
1088 	 * should fit into that.
1089 	 */
1090 	if (result > 0) {
1091 		if (us->iobuf[0] < 16) {
1092 			return us->iobuf[0];
1093 		} else {
1094 			dev_info(&us->pusb_intf->dev,
1095 				 "Max LUN %d is not valid, using 0 instead",
1096 				 us->iobuf[0]);
1097 		}
1098 	}
1099 
1100 	/*
1101 	 * Some devices don't like GetMaxLUN.  They may STALL the control
1102 	 * pipe, they may return a zero-length result, they may do nothing at
1103 	 * all and timeout, or they may fail in even more bizarrely creative
1104 	 * ways.  In these cases the best approach is to use the default
1105 	 * value: only one LUN.
1106 	 */
1107 	return 0;
1108 }
1109 
usb_stor_Bulk_transport(struct scsi_cmnd * srb,struct us_data * us)1110 int usb_stor_Bulk_transport(struct scsi_cmnd *srb, struct us_data *us)
1111 {
1112 	struct bulk_cb_wrap *bcb = (struct bulk_cb_wrap *) us->iobuf;
1113 	struct bulk_cs_wrap *bcs = (struct bulk_cs_wrap *) us->iobuf;
1114 	unsigned int transfer_length = scsi_bufflen(srb);
1115 	unsigned int residue;
1116 	int result;
1117 	int fake_sense = 0;
1118 	unsigned int cswlen;
1119 	unsigned int cbwlen = US_BULK_CB_WRAP_LEN;
1120 
1121 	/* Take care of BULK32 devices; set extra byte to 0 */
1122 	if (unlikely(us->fflags & US_FL_BULK32)) {
1123 		cbwlen = 32;
1124 		us->iobuf[31] = 0;
1125 	}
1126 
1127 	/* set up the command wrapper */
1128 	bcb->Signature = cpu_to_le32(US_BULK_CB_SIGN);
1129 	bcb->DataTransferLength = cpu_to_le32(transfer_length);
1130 	bcb->Flags = srb->sc_data_direction == DMA_FROM_DEVICE ?
1131 		US_BULK_FLAG_IN : 0;
1132 	bcb->Tag = ++us->tag;
1133 	bcb->Lun = srb->device->lun;
1134 	if (us->fflags & US_FL_SCM_MULT_TARG)
1135 		bcb->Lun |= srb->device->id << 4;
1136 	bcb->Length = srb->cmd_len;
1137 
1138 	/* copy the command payload */
1139 	memset(bcb->CDB, 0, sizeof(bcb->CDB));
1140 	memcpy(bcb->CDB, srb->cmnd, bcb->Length);
1141 
1142 	/* send it to out endpoint */
1143 	usb_stor_dbg(us, "Bulk Command S 0x%x T 0x%x L %d F %d Trg %d LUN %d CL %d\n",
1144 		     le32_to_cpu(bcb->Signature), bcb->Tag,
1145 		     le32_to_cpu(bcb->DataTransferLength), bcb->Flags,
1146 		     (bcb->Lun >> 4), (bcb->Lun & 0x0F),
1147 		     bcb->Length);
1148 	result = usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,
1149 				bcb, cbwlen, NULL);
1150 	usb_stor_dbg(us, "Bulk command transfer result=%d\n", result);
1151 	if (result != USB_STOR_XFER_GOOD)
1152 		return USB_STOR_TRANSPORT_ERROR;
1153 
1154 	/* DATA STAGE */
1155 	/* send/receive data payload, if there is any */
1156 
1157 	/*
1158 	 * Some USB-IDE converter chips need a 100us delay between the
1159 	 * command phase and the data phase.  Some devices need a little
1160 	 * more than that, probably because of clock rate inaccuracies.
1161 	 */
1162 	if (unlikely(us->fflags & US_FL_GO_SLOW))
1163 		usleep_range(125, 150);
1164 
1165 	if (transfer_length) {
1166 		unsigned int pipe = srb->sc_data_direction == DMA_FROM_DEVICE ?
1167 				us->recv_bulk_pipe : us->send_bulk_pipe;
1168 		result = usb_stor_bulk_srb(us, pipe, srb);
1169 		usb_stor_dbg(us, "Bulk data transfer result 0x%x\n", result);
1170 		if (result == USB_STOR_XFER_ERROR)
1171 			return USB_STOR_TRANSPORT_ERROR;
1172 
1173 		/*
1174 		 * If the device tried to send back more data than the
1175 		 * amount requested, the spec requires us to transfer
1176 		 * the CSW anyway.  Since there's no point retrying the
1177 		 * the command, we'll return fake sense data indicating
1178 		 * Illegal Request, Invalid Field in CDB.
1179 		 */
1180 		if (result == USB_STOR_XFER_LONG)
1181 			fake_sense = 1;
1182 
1183 		/*
1184 		 * Sometimes a device will mistakenly skip the data phase
1185 		 * and go directly to the status phase without sending a
1186 		 * zero-length packet.  If we get a 13-byte response here,
1187 		 * check whether it really is a CSW.
1188 		 */
1189 		if (result == USB_STOR_XFER_SHORT &&
1190 				srb->sc_data_direction == DMA_FROM_DEVICE &&
1191 				transfer_length - scsi_get_resid(srb) ==
1192 					US_BULK_CS_WRAP_LEN) {
1193 			struct scatterlist *sg = NULL;
1194 			unsigned int offset = 0;
1195 
1196 			if (usb_stor_access_xfer_buf((unsigned char *) bcs,
1197 					US_BULK_CS_WRAP_LEN, srb, &sg,
1198 					&offset, FROM_XFER_BUF) ==
1199 						US_BULK_CS_WRAP_LEN &&
1200 					bcs->Signature ==
1201 						cpu_to_le32(US_BULK_CS_SIGN)) {
1202 				usb_stor_dbg(us, "Device skipped data phase\n");
1203 				scsi_set_resid(srb, transfer_length);
1204 				goto skipped_data_phase;
1205 			}
1206 		}
1207 	}
1208 
1209 	/*
1210 	 * See flow chart on pg 15 of the Bulk Only Transport spec for
1211 	 * an explanation of how this code works.
1212 	 */
1213 
1214 	/* get CSW for device status */
1215 	usb_stor_dbg(us, "Attempting to get CSW...\n");
1216 	result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1217 				bcs, US_BULK_CS_WRAP_LEN, &cswlen);
1218 
1219 	/*
1220 	 * Some broken devices add unnecessary zero-length packets to the
1221 	 * end of their data transfers.  Such packets show up as 0-length
1222 	 * CSWs.  If we encounter such a thing, try to read the CSW again.
1223 	 */
1224 	if (result == USB_STOR_XFER_SHORT && cswlen == 0) {
1225 		usb_stor_dbg(us, "Received 0-length CSW; retrying...\n");
1226 		result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1227 				bcs, US_BULK_CS_WRAP_LEN, &cswlen);
1228 	}
1229 
1230 	/* did the attempt to read the CSW fail? */
1231 	if (result == USB_STOR_XFER_STALLED) {
1232 
1233 		/* get the status again */
1234 		usb_stor_dbg(us, "Attempting to get CSW (2nd try)...\n");
1235 		result = usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
1236 				bcs, US_BULK_CS_WRAP_LEN, NULL);
1237 	}
1238 
1239 	/* if we still have a failure at this point, we're in trouble */
1240 	usb_stor_dbg(us, "Bulk status result = %d\n", result);
1241 	if (result != USB_STOR_XFER_GOOD)
1242 		return USB_STOR_TRANSPORT_ERROR;
1243 
1244  skipped_data_phase:
1245 	/* check bulk status */
1246 	residue = le32_to_cpu(bcs->Residue);
1247 	usb_stor_dbg(us, "Bulk Status S 0x%x T 0x%x R %u Stat 0x%x\n",
1248 		     le32_to_cpu(bcs->Signature), bcs->Tag,
1249 		     residue, bcs->Status);
1250 	if (!(bcs->Tag == us->tag || (us->fflags & US_FL_BULK_IGNORE_TAG)) ||
1251 		bcs->Status > US_BULK_STAT_PHASE) {
1252 		usb_stor_dbg(us, "Bulk logical error\n");
1253 		return USB_STOR_TRANSPORT_ERROR;
1254 	}
1255 
1256 	/*
1257 	 * Some broken devices report odd signatures, so we do not check them
1258 	 * for validity against the spec. We store the first one we see,
1259 	 * and check subsequent transfers for validity against this signature.
1260 	 */
1261 	if (!us->bcs_signature) {
1262 		us->bcs_signature = bcs->Signature;
1263 		if (us->bcs_signature != cpu_to_le32(US_BULK_CS_SIGN))
1264 			usb_stor_dbg(us, "Learnt BCS signature 0x%08X\n",
1265 				     le32_to_cpu(us->bcs_signature));
1266 	} else if (bcs->Signature != us->bcs_signature) {
1267 		usb_stor_dbg(us, "Signature mismatch: got %08X, expecting %08X\n",
1268 			     le32_to_cpu(bcs->Signature),
1269 			     le32_to_cpu(us->bcs_signature));
1270 		return USB_STOR_TRANSPORT_ERROR;
1271 	}
1272 
1273 	/*
1274 	 * try to compute the actual residue, based on how much data
1275 	 * was really transferred and what the device tells us
1276 	 */
1277 	if (residue && !(us->fflags & US_FL_IGNORE_RESIDUE)) {
1278 
1279 		/*
1280 		 * Heuristically detect devices that generate bogus residues
1281 		 * by seeing what happens with INQUIRY and READ CAPACITY
1282 		 * commands.
1283 		 */
1284 		if (bcs->Status == US_BULK_STAT_OK &&
1285 				scsi_get_resid(srb) == 0 &&
1286 					((srb->cmnd[0] == INQUIRY &&
1287 						transfer_length == 36) ||
1288 					(srb->cmnd[0] == READ_CAPACITY &&
1289 						transfer_length == 8))) {
1290 			us->fflags |= US_FL_IGNORE_RESIDUE;
1291 
1292 		} else {
1293 			residue = min(residue, transfer_length);
1294 			scsi_set_resid(srb, max(scsi_get_resid(srb), residue));
1295 		}
1296 	}
1297 
1298 	/* based on the status code, we report good or bad */
1299 	switch (bcs->Status) {
1300 		case US_BULK_STAT_OK:
1301 			/* device babbled -- return fake sense data */
1302 			if (fake_sense) {
1303 				memcpy(srb->sense_buffer,
1304 				       usb_stor_sense_invalidCDB,
1305 				       sizeof(usb_stor_sense_invalidCDB));
1306 				return USB_STOR_TRANSPORT_NO_SENSE;
1307 			}
1308 
1309 			/* command good -- note that data could be short */
1310 			return USB_STOR_TRANSPORT_GOOD;
1311 
1312 		case US_BULK_STAT_FAIL:
1313 			/* command failed */
1314 			return USB_STOR_TRANSPORT_FAILED;
1315 
1316 		case US_BULK_STAT_PHASE:
1317 			/*
1318 			 * phase error -- note that a transport reset will be
1319 			 * invoked by the invoke_transport() function
1320 			 */
1321 			return USB_STOR_TRANSPORT_ERROR;
1322 	}
1323 
1324 	/* we should never get here, but if we do, we're in trouble */
1325 	return USB_STOR_TRANSPORT_ERROR;
1326 }
1327 EXPORT_SYMBOL_GPL(usb_stor_Bulk_transport);
1328 
1329 /***********************************************************************
1330  * Reset routines
1331  ***********************************************************************/
1332 
1333 /*
1334  * This is the common part of the device reset code.
1335  *
1336  * It's handy that every transport mechanism uses the control endpoint for
1337  * resets.
1338  *
1339  * Basically, we send a reset with a 5-second timeout, so we don't get
1340  * jammed attempting to do the reset.
1341  */
usb_stor_reset_common(struct us_data * us,u8 request,u8 requesttype,u16 value,u16 index,void * data,u16 size)1342 static int usb_stor_reset_common(struct us_data *us,
1343 		u8 request, u8 requesttype,
1344 		u16 value, u16 index, void *data, u16 size)
1345 {
1346 	int result;
1347 	int result2;
1348 
1349 	if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1350 		usb_stor_dbg(us, "No reset during disconnect\n");
1351 		return -EIO;
1352 	}
1353 
1354 	result = usb_stor_control_msg(us, us->send_ctrl_pipe,
1355 			request, requesttype, value, index, data, size,
1356 			5*HZ);
1357 	if (result < 0) {
1358 		usb_stor_dbg(us, "Soft reset failed: %d\n", result);
1359 		return result;
1360 	}
1361 
1362 	/*
1363 	 * Give the device some time to recover from the reset,
1364 	 * but don't delay disconnect processing.
1365 	 */
1366 	wait_event_interruptible_timeout(us->delay_wait,
1367 			test_bit(US_FLIDX_DISCONNECTING, &us->dflags),
1368 			HZ*6);
1369 	if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1370 		usb_stor_dbg(us, "Reset interrupted by disconnect\n");
1371 		return -EIO;
1372 	}
1373 
1374 	usb_stor_dbg(us, "Soft reset: clearing bulk-in endpoint halt\n");
1375 	result = usb_stor_clear_halt(us, us->recv_bulk_pipe);
1376 
1377 	usb_stor_dbg(us, "Soft reset: clearing bulk-out endpoint halt\n");
1378 	result2 = usb_stor_clear_halt(us, us->send_bulk_pipe);
1379 
1380 	/* return a result code based on the result of the clear-halts */
1381 	if (result >= 0)
1382 		result = result2;
1383 	if (result < 0)
1384 		usb_stor_dbg(us, "Soft reset failed\n");
1385 	else
1386 		usb_stor_dbg(us, "Soft reset done\n");
1387 	return result;
1388 }
1389 
1390 /* This issues a CB[I] Reset to the device in question */
1391 #define CB_RESET_CMD_SIZE	12
1392 
usb_stor_CB_reset(struct us_data * us)1393 int usb_stor_CB_reset(struct us_data *us)
1394 {
1395 	memset(us->iobuf, 0xFF, CB_RESET_CMD_SIZE);
1396 	us->iobuf[0] = SEND_DIAGNOSTIC;
1397 	us->iobuf[1] = 4;
1398 	return usb_stor_reset_common(us, US_CBI_ADSC,
1399 				 USB_TYPE_CLASS | USB_RECIP_INTERFACE,
1400 				 0, us->ifnum, us->iobuf, CB_RESET_CMD_SIZE);
1401 }
1402 EXPORT_SYMBOL_GPL(usb_stor_CB_reset);
1403 
1404 /*
1405  * This issues a Bulk-only Reset to the device in question, including
1406  * clearing the subsequent endpoint halts that may occur.
1407  */
usb_stor_Bulk_reset(struct us_data * us)1408 int usb_stor_Bulk_reset(struct us_data *us)
1409 {
1410 	return usb_stor_reset_common(us, US_BULK_RESET_REQUEST,
1411 				 USB_TYPE_CLASS | USB_RECIP_INTERFACE,
1412 				 0, us->ifnum, NULL, 0);
1413 }
1414 EXPORT_SYMBOL_GPL(usb_stor_Bulk_reset);
1415 
1416 /*
1417  * Issue a USB port reset to the device.  The caller must not hold
1418  * us->dev_mutex.
1419  */
usb_stor_port_reset(struct us_data * us)1420 int usb_stor_port_reset(struct us_data *us)
1421 {
1422 	int result;
1423 
1424 	/*for these devices we must use the class specific method */
1425 	if (us->pusb_dev->quirks & USB_QUIRK_RESET)
1426 		return -EPERM;
1427 
1428 	result = usb_lock_device_for_reset(us->pusb_dev, us->pusb_intf);
1429 	if (result < 0)
1430 		usb_stor_dbg(us, "unable to lock device for reset: %d\n",
1431 			     result);
1432 	else {
1433 		/* Were we disconnected while waiting for the lock? */
1434 		if (test_bit(US_FLIDX_DISCONNECTING, &us->dflags)) {
1435 			result = -EIO;
1436 			usb_stor_dbg(us, "No reset during disconnect\n");
1437 		} else {
1438 			result = usb_reset_device(us->pusb_dev);
1439 			usb_stor_dbg(us, "usb_reset_device returns %d\n",
1440 				     result);
1441 		}
1442 		usb_unlock_device(us->pusb_dev);
1443 	}
1444 	return result;
1445 }
1446