xref: /openbmc/linux/drivers/usb/storage/jumpshot.c (revision 545e4006)
1 /* Driver for Lexar "Jumpshot" Compact Flash reader
2  *
3  * jumpshot driver v0.1:
4  *
5  * First release
6  *
7  * Current development and maintenance by:
8  *   (c) 2000 Jimmie Mayfield (mayfield+usb@sackheads.org)
9  *
10  *   Many thanks to Robert Baruch for the SanDisk SmartMedia reader driver
11  *   which I used as a template for this driver.
12  *
13  *   Some bugfixes and scatter-gather code by Gregory P. Smith
14  *   (greg-usb@electricrain.com)
15  *
16  *   Fix for media change by Joerg Schneider (js@joergschneider.com)
17  *
18  * Developed with the assistance of:
19  *
20  *   (C) 2002 Alan Stern <stern@rowland.org>
21  *
22  * This program is free software; you can redistribute it and/or modify it
23  * under the terms of the GNU General Public License as published by the
24  * Free Software Foundation; either version 2, or (at your option) any
25  * later version.
26  *
27  * This program is distributed in the hope that it will be useful, but
28  * WITHOUT ANY WARRANTY; without even the implied warranty of
29  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
30  * General Public License for more details.
31  *
32  * You should have received a copy of the GNU General Public License along
33  * with this program; if not, write to the Free Software Foundation, Inc.,
34  * 675 Mass Ave, Cambridge, MA 02139, USA.
35  */
36 
37  /*
38   * This driver attempts to support the Lexar Jumpshot USB CompactFlash
39   * reader.  Like many other USB CompactFlash readers, the Jumpshot contains
40   * a USB-to-ATA chip.
41   *
42   * This driver supports reading and writing.  If you're truly paranoid,
43   * however, you can force the driver into a write-protected state by setting
44   * the WP enable bits in jumpshot_handle_mode_sense.  See the comments
45   * in that routine.
46   */
47 
48 #include <linux/errno.h>
49 #include <linux/slab.h>
50 
51 #include <scsi/scsi.h>
52 #include <scsi/scsi_cmnd.h>
53 
54 #include "usb.h"
55 #include "transport.h"
56 #include "protocol.h"
57 #include "debug.h"
58 #include "jumpshot.h"
59 
60 
61 static inline int jumpshot_bulk_read(struct us_data *us,
62 				     unsigned char *data,
63 				     unsigned int len)
64 {
65 	if (len == 0)
66 		return USB_STOR_XFER_GOOD;
67 
68 	US_DEBUGP("jumpshot_bulk_read:  len = %d\n", len);
69 	return usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
70 			data, len, NULL);
71 }
72 
73 
74 static inline int jumpshot_bulk_write(struct us_data *us,
75 				      unsigned char *data,
76 				      unsigned int len)
77 {
78 	if (len == 0)
79 		return USB_STOR_XFER_GOOD;
80 
81 	US_DEBUGP("jumpshot_bulk_write:  len = %d\n", len);
82 	return usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,
83 			data, len, NULL);
84 }
85 
86 
87 static int jumpshot_get_status(struct us_data  *us)
88 {
89 	int rc;
90 
91 	if (!us)
92 		return USB_STOR_TRANSPORT_ERROR;
93 
94 	// send the setup
95 	rc = usb_stor_ctrl_transfer(us, us->recv_ctrl_pipe,
96 				   0, 0xA0, 0, 7, us->iobuf, 1);
97 
98 	if (rc != USB_STOR_XFER_GOOD)
99 		return USB_STOR_TRANSPORT_ERROR;
100 
101 	if (us->iobuf[0] != 0x50) {
102 		US_DEBUGP("jumpshot_get_status:  0x%2x\n",
103 			  us->iobuf[0]);
104 		return USB_STOR_TRANSPORT_ERROR;
105 	}
106 
107 	return USB_STOR_TRANSPORT_GOOD;
108 }
109 
110 static int jumpshot_read_data(struct us_data *us,
111 			      struct jumpshot_info *info,
112 			      u32 sector,
113 			      u32 sectors)
114 {
115 	unsigned char *command = us->iobuf;
116 	unsigned char *buffer;
117 	unsigned char  thistime;
118 	unsigned int totallen, alloclen;
119 	int len, result;
120 	unsigned int sg_offset = 0;
121 	struct scatterlist *sg = NULL;
122 
123 	// we're working in LBA mode.  according to the ATA spec,
124 	// we can support up to 28-bit addressing.  I don't know if Jumpshot
125 	// supports beyond 24-bit addressing.  It's kind of hard to test
126 	// since it requires > 8GB CF card.
127 
128 	if (sector > 0x0FFFFFFF)
129 		return USB_STOR_TRANSPORT_ERROR;
130 
131 	totallen = sectors * info->ssize;
132 
133 	// Since we don't read more than 64 KB at a time, we have to create
134 	// a bounce buffer and move the data a piece at a time between the
135 	// bounce buffer and the actual transfer buffer.
136 
137 	alloclen = min(totallen, 65536u);
138 	buffer = kmalloc(alloclen, GFP_NOIO);
139 	if (buffer == NULL)
140 		return USB_STOR_TRANSPORT_ERROR;
141 
142 	do {
143 		// loop, never allocate or transfer more than 64k at once
144 		// (min(128k, 255*info->ssize) is the real limit)
145 		len = min(totallen, alloclen);
146 		thistime = (len / info->ssize) & 0xff;
147 
148 		command[0] = 0;
149 		command[1] = thistime;
150 		command[2] = sector & 0xFF;
151 		command[3] = (sector >>  8) & 0xFF;
152 		command[4] = (sector >> 16) & 0xFF;
153 
154 		command[5] = 0xE0 | ((sector >> 24) & 0x0F);
155 		command[6] = 0x20;
156 
157 		// send the setup + command
158 		result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
159 					       0, 0x20, 0, 1, command, 7);
160 		if (result != USB_STOR_XFER_GOOD)
161 			goto leave;
162 
163 		// read the result
164 		result = jumpshot_bulk_read(us, buffer, len);
165 		if (result != USB_STOR_XFER_GOOD)
166 			goto leave;
167 
168 		US_DEBUGP("jumpshot_read_data:  %d bytes\n", len);
169 
170 		// Store the data in the transfer buffer
171 		usb_stor_access_xfer_buf(buffer, len, us->srb,
172 				 &sg, &sg_offset, TO_XFER_BUF);
173 
174 		sector += thistime;
175 		totallen -= len;
176 	} while (totallen > 0);
177 
178 	kfree(buffer);
179 	return USB_STOR_TRANSPORT_GOOD;
180 
181  leave:
182 	kfree(buffer);
183 	return USB_STOR_TRANSPORT_ERROR;
184 }
185 
186 
187 static int jumpshot_write_data(struct us_data *us,
188 			       struct jumpshot_info *info,
189 			       u32 sector,
190 			       u32 sectors)
191 {
192 	unsigned char *command = us->iobuf;
193 	unsigned char *buffer;
194 	unsigned char  thistime;
195 	unsigned int totallen, alloclen;
196 	int len, result, waitcount;
197 	unsigned int sg_offset = 0;
198 	struct scatterlist *sg = NULL;
199 
200 	// we're working in LBA mode.  according to the ATA spec,
201 	// we can support up to 28-bit addressing.  I don't know if Jumpshot
202 	// supports beyond 24-bit addressing.  It's kind of hard to test
203 	// since it requires > 8GB CF card.
204 	//
205 	if (sector > 0x0FFFFFFF)
206 		return USB_STOR_TRANSPORT_ERROR;
207 
208 	totallen = sectors * info->ssize;
209 
210 	// Since we don't write more than 64 KB at a time, we have to create
211 	// a bounce buffer and move the data a piece at a time between the
212 	// bounce buffer and the actual transfer buffer.
213 
214 	alloclen = min(totallen, 65536u);
215 	buffer = kmalloc(alloclen, GFP_NOIO);
216 	if (buffer == NULL)
217 		return USB_STOR_TRANSPORT_ERROR;
218 
219 	do {
220 		// loop, never allocate or transfer more than 64k at once
221 		// (min(128k, 255*info->ssize) is the real limit)
222 
223 		len = min(totallen, alloclen);
224 		thistime = (len / info->ssize) & 0xff;
225 
226 		// Get the data from the transfer buffer
227 		usb_stor_access_xfer_buf(buffer, len, us->srb,
228 				&sg, &sg_offset, FROM_XFER_BUF);
229 
230 		command[0] = 0;
231 		command[1] = thistime;
232 		command[2] = sector & 0xFF;
233 		command[3] = (sector >>  8) & 0xFF;
234 		command[4] = (sector >> 16) & 0xFF;
235 
236 		command[5] = 0xE0 | ((sector >> 24) & 0x0F);
237 		command[6] = 0x30;
238 
239 		// send the setup + command
240 		result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
241 			0, 0x20, 0, 1, command, 7);
242 		if (result != USB_STOR_XFER_GOOD)
243 			goto leave;
244 
245 		// send the data
246 		result = jumpshot_bulk_write(us, buffer, len);
247 		if (result != USB_STOR_XFER_GOOD)
248 			goto leave;
249 
250 		// read the result.  apparently the bulk write can complete
251 		// before the jumpshot drive is finished writing.  so we loop
252 		// here until we get a good return code
253 		waitcount = 0;
254 		do {
255 			result = jumpshot_get_status(us);
256 			if (result != USB_STOR_TRANSPORT_GOOD) {
257 				// I have not experimented to find the smallest value.
258 				//
259 				msleep(50);
260 			}
261 		} while ((result != USB_STOR_TRANSPORT_GOOD) && (waitcount < 10));
262 
263 		if (result != USB_STOR_TRANSPORT_GOOD)
264 			US_DEBUGP("jumpshot_write_data:  Gah!  Waitcount = 10.  Bad write!?\n");
265 
266 		sector += thistime;
267 		totallen -= len;
268 	} while (totallen > 0);
269 
270 	kfree(buffer);
271 	return result;
272 
273  leave:
274 	kfree(buffer);
275 	return USB_STOR_TRANSPORT_ERROR;
276 }
277 
278 static int jumpshot_id_device(struct us_data *us,
279 			      struct jumpshot_info *info)
280 {
281 	unsigned char *command = us->iobuf;
282 	unsigned char *reply;
283 	int 	 rc;
284 
285 	if (!us || !info)
286 		return USB_STOR_TRANSPORT_ERROR;
287 
288 	command[0] = 0xE0;
289 	command[1] = 0xEC;
290 	reply = kmalloc(512, GFP_NOIO);
291 	if (!reply)
292 		return USB_STOR_TRANSPORT_ERROR;
293 
294 	// send the setup
295 	rc = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
296 				   0, 0x20, 0, 6, command, 2);
297 
298 	if (rc != USB_STOR_XFER_GOOD) {
299 		US_DEBUGP("jumpshot_id_device:  Gah! "
300 			  "send_control for read_capacity failed\n");
301 		rc = USB_STOR_TRANSPORT_ERROR;
302 		goto leave;
303 	}
304 
305 	// read the reply
306 	rc = jumpshot_bulk_read(us, reply, 512);
307 	if (rc != USB_STOR_XFER_GOOD) {
308 		rc = USB_STOR_TRANSPORT_ERROR;
309 		goto leave;
310 	}
311 
312 	info->sectors = ((u32)(reply[117]) << 24) |
313 			((u32)(reply[116]) << 16) |
314 			((u32)(reply[115]) <<  8) |
315 			((u32)(reply[114])      );
316 
317 	rc = USB_STOR_TRANSPORT_GOOD;
318 
319  leave:
320 	kfree(reply);
321 	return rc;
322 }
323 
324 static int jumpshot_handle_mode_sense(struct us_data *us,
325 				      struct scsi_cmnd * srb,
326 				      int sense_6)
327 {
328 	static unsigned char rw_err_page[12] = {
329 		0x1, 0xA, 0x21, 1, 0, 0, 0, 0, 1, 0, 0, 0
330 	};
331 	static unsigned char cache_page[12] = {
332 		0x8, 0xA, 0x1, 0, 0, 0, 0, 0, 0, 0, 0, 0
333 	};
334 	static unsigned char rbac_page[12] = {
335 		0x1B, 0xA, 0, 0x81, 0, 0, 0, 0, 0, 0, 0, 0
336 	};
337 	static unsigned char timer_page[8] = {
338 		0x1C, 0x6, 0, 0, 0, 0
339 	};
340 	unsigned char pc, page_code;
341 	unsigned int i = 0;
342 	struct jumpshot_info *info = (struct jumpshot_info *) (us->extra);
343 	unsigned char *ptr = us->iobuf;
344 
345 	pc = srb->cmnd[2] >> 6;
346 	page_code = srb->cmnd[2] & 0x3F;
347 
348 	switch (pc) {
349 	   case 0x0:
350 		US_DEBUGP("jumpshot_handle_mode_sense:  Current values\n");
351 		break;
352 	   case 0x1:
353 		US_DEBUGP("jumpshot_handle_mode_sense:  Changeable values\n");
354 		break;
355 	   case 0x2:
356 		US_DEBUGP("jumpshot_handle_mode_sense:  Default values\n");
357 		break;
358 	   case 0x3:
359 		US_DEBUGP("jumpshot_handle_mode_sense:  Saves values\n");
360 		break;
361 	}
362 
363 	memset(ptr, 0, 8);
364 	if (sense_6) {
365 		ptr[2] = 0x00;		// WP enable: 0x80
366 		i = 4;
367 	} else {
368 		ptr[3] = 0x00;		// WP enable: 0x80
369 		i = 8;
370 	}
371 
372 	switch (page_code) {
373 	   case 0x0:
374 		// vendor-specific mode
375 		info->sense_key = 0x05;
376 		info->sense_asc = 0x24;
377 		info->sense_ascq = 0x00;
378 		return USB_STOR_TRANSPORT_FAILED;
379 
380 	   case 0x1:
381 		memcpy(ptr + i, rw_err_page, sizeof(rw_err_page));
382 		i += sizeof(rw_err_page);
383 		break;
384 
385 	   case 0x8:
386 		memcpy(ptr + i, cache_page, sizeof(cache_page));
387 		i += sizeof(cache_page);
388 		break;
389 
390 	   case 0x1B:
391 		memcpy(ptr + i, rbac_page, sizeof(rbac_page));
392 		i += sizeof(rbac_page);
393 		break;
394 
395 	   case 0x1C:
396 		memcpy(ptr + i, timer_page, sizeof(timer_page));
397 		i += sizeof(timer_page);
398 		break;
399 
400 	   case 0x3F:
401 		memcpy(ptr + i, timer_page, sizeof(timer_page));
402 		i += sizeof(timer_page);
403 		memcpy(ptr + i, rbac_page, sizeof(rbac_page));
404 		i += sizeof(rbac_page);
405 		memcpy(ptr + i, cache_page, sizeof(cache_page));
406 		i += sizeof(cache_page);
407 		memcpy(ptr + i, rw_err_page, sizeof(rw_err_page));
408 		i += sizeof(rw_err_page);
409 		break;
410 	}
411 
412 	if (sense_6)
413 		ptr[0] = i - 1;
414 	else
415 		((__be16 *) ptr)[0] = cpu_to_be16(i - 2);
416 	usb_stor_set_xfer_buf(ptr, i, srb);
417 
418 	return USB_STOR_TRANSPORT_GOOD;
419 }
420 
421 
422 static void jumpshot_info_destructor(void *extra)
423 {
424 	// this routine is a placeholder...
425 	// currently, we don't allocate any extra blocks so we're okay
426 }
427 
428 
429 
430 // Transport for the Lexar 'Jumpshot'
431 //
432 int jumpshot_transport(struct scsi_cmnd * srb, struct us_data *us)
433 {
434 	struct jumpshot_info *info;
435 	int rc;
436 	unsigned long block, blocks;
437 	unsigned char *ptr = us->iobuf;
438 	static unsigned char inquiry_response[8] = {
439 		0x00, 0x80, 0x00, 0x01, 0x1F, 0x00, 0x00, 0x00
440 	};
441 
442 	if (!us->extra) {
443 		us->extra = kzalloc(sizeof(struct jumpshot_info), GFP_NOIO);
444 		if (!us->extra) {
445 			US_DEBUGP("jumpshot_transport:  Gah! Can't allocate storage for jumpshot info struct!\n");
446 			return USB_STOR_TRANSPORT_ERROR;
447 		}
448 		us->extra_destructor = jumpshot_info_destructor;
449 	}
450 
451 	info = (struct jumpshot_info *) (us->extra);
452 
453 	if (srb->cmnd[0] == INQUIRY) {
454 		US_DEBUGP("jumpshot_transport:  INQUIRY.  Returning bogus response.\n");
455 		memcpy(ptr, inquiry_response, sizeof(inquiry_response));
456 		fill_inquiry_response(us, ptr, 36);
457 		return USB_STOR_TRANSPORT_GOOD;
458 	}
459 
460 	if (srb->cmnd[0] == READ_CAPACITY) {
461 		info->ssize = 0x200;  // hard coded 512 byte sectors as per ATA spec
462 
463 		rc = jumpshot_get_status(us);
464 		if (rc != USB_STOR_TRANSPORT_GOOD)
465 			return rc;
466 
467 		rc = jumpshot_id_device(us, info);
468 		if (rc != USB_STOR_TRANSPORT_GOOD)
469 			return rc;
470 
471 		US_DEBUGP("jumpshot_transport:  READ_CAPACITY:  %ld sectors, %ld bytes per sector\n",
472 			  info->sectors, info->ssize);
473 
474 		// build the reply
475 		//
476 		((__be32 *) ptr)[0] = cpu_to_be32(info->sectors - 1);
477 		((__be32 *) ptr)[1] = cpu_to_be32(info->ssize);
478 		usb_stor_set_xfer_buf(ptr, 8, srb);
479 
480 		return USB_STOR_TRANSPORT_GOOD;
481 	}
482 
483 	if (srb->cmnd[0] == MODE_SELECT_10) {
484 		US_DEBUGP("jumpshot_transport:  Gah! MODE_SELECT_10.\n");
485 		return USB_STOR_TRANSPORT_ERROR;
486 	}
487 
488 	if (srb->cmnd[0] == READ_10) {
489 		block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
490 			((u32)(srb->cmnd[4]) <<  8) | ((u32)(srb->cmnd[5]));
491 
492 		blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
493 
494 		US_DEBUGP("jumpshot_transport:  READ_10: read block 0x%04lx  count %ld\n", block, blocks);
495 		return jumpshot_read_data(us, info, block, blocks);
496 	}
497 
498 	if (srb->cmnd[0] == READ_12) {
499 		// I don't think we'll ever see a READ_12 but support it anyway...
500 		//
501 		block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
502 			((u32)(srb->cmnd[4]) <<  8) | ((u32)(srb->cmnd[5]));
503 
504 		blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
505 			 ((u32)(srb->cmnd[8]) <<  8) | ((u32)(srb->cmnd[9]));
506 
507 		US_DEBUGP("jumpshot_transport:  READ_12: read block 0x%04lx  count %ld\n", block, blocks);
508 		return jumpshot_read_data(us, info, block, blocks);
509 	}
510 
511 	if (srb->cmnd[0] == WRITE_10) {
512 		block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
513 			((u32)(srb->cmnd[4]) <<  8) | ((u32)(srb->cmnd[5]));
514 
515 		blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
516 
517 		US_DEBUGP("jumpshot_transport:  WRITE_10: write block 0x%04lx  count %ld\n", block, blocks);
518 		return jumpshot_write_data(us, info, block, blocks);
519 	}
520 
521 	if (srb->cmnd[0] == WRITE_12) {
522 		// I don't think we'll ever see a WRITE_12 but support it anyway...
523 		//
524 		block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
525 			((u32)(srb->cmnd[4]) <<  8) | ((u32)(srb->cmnd[5]));
526 
527 		blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
528 			 ((u32)(srb->cmnd[8]) <<  8) | ((u32)(srb->cmnd[9]));
529 
530 		US_DEBUGP("jumpshot_transport:  WRITE_12: write block 0x%04lx  count %ld\n", block, blocks);
531 		return jumpshot_write_data(us, info, block, blocks);
532 	}
533 
534 
535 	if (srb->cmnd[0] == TEST_UNIT_READY) {
536 		US_DEBUGP("jumpshot_transport:  TEST_UNIT_READY.\n");
537 		return jumpshot_get_status(us);
538 	}
539 
540 	if (srb->cmnd[0] == REQUEST_SENSE) {
541 		US_DEBUGP("jumpshot_transport:  REQUEST_SENSE.\n");
542 
543 		memset(ptr, 0, 18);
544 		ptr[0] = 0xF0;
545 		ptr[2] = info->sense_key;
546 		ptr[7] = 11;
547 		ptr[12] = info->sense_asc;
548 		ptr[13] = info->sense_ascq;
549 		usb_stor_set_xfer_buf(ptr, 18, srb);
550 
551 		return USB_STOR_TRANSPORT_GOOD;
552 	}
553 
554 	if (srb->cmnd[0] == MODE_SENSE) {
555 		US_DEBUGP("jumpshot_transport:  MODE_SENSE_6 detected\n");
556 		return jumpshot_handle_mode_sense(us, srb, 1);
557 	}
558 
559 	if (srb->cmnd[0] == MODE_SENSE_10) {
560 		US_DEBUGP("jumpshot_transport:  MODE_SENSE_10 detected\n");
561 		return jumpshot_handle_mode_sense(us, srb, 0);
562 	}
563 
564 	if (srb->cmnd[0] == ALLOW_MEDIUM_REMOVAL) {
565 		// sure.  whatever.  not like we can stop the user from popping
566 		// the media out of the device (no locking doors, etc)
567 		//
568 		return USB_STOR_TRANSPORT_GOOD;
569 	}
570 
571 	if (srb->cmnd[0] == START_STOP) {
572 		/* this is used by sd.c'check_scsidisk_media_change to detect
573 		   media change */
574 		US_DEBUGP("jumpshot_transport:  START_STOP.\n");
575 		/* the first jumpshot_id_device after a media change returns
576 		   an error (determined experimentally) */
577 		rc = jumpshot_id_device(us, info);
578 		if (rc == USB_STOR_TRANSPORT_GOOD) {
579 			info->sense_key = NO_SENSE;
580 			srb->result = SUCCESS;
581 		} else {
582 			info->sense_key = UNIT_ATTENTION;
583 			srb->result = SAM_STAT_CHECK_CONDITION;
584 		}
585 		return rc;
586 	}
587 
588 	US_DEBUGP("jumpshot_transport:  Gah! Unknown command: %d (0x%x)\n",
589 		  srb->cmnd[0], srb->cmnd[0]);
590 	info->sense_key = 0x05;
591 	info->sense_asc = 0x20;
592 	info->sense_ascq = 0x00;
593 	return USB_STOR_TRANSPORT_FAILED;
594 }
595