1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49#include <linux/errno.h>
50#include <linux/module.h>
51#include <linux/slab.h>
52
53#include <scsi/scsi.h>
54#include <scsi/scsi_cmnd.h>
55
56#include "usb.h"
57#include "transport.h"
58#include "protocol.h"
59#include "debug.h"
60#include "scsiglue.h"
61
62#define DRV_NAME "ums-jumpshot"
63
64MODULE_DESCRIPTION("Driver for Lexar \"Jumpshot\" Compact Flash reader");
65MODULE_AUTHOR("Jimmie Mayfield <mayfield+usb@sackheads.org>");
66MODULE_LICENSE("GPL");
67
68
69
70
71#define UNUSUAL_DEV(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax, \
72 vendorName, productName, useProtocol, useTransport, \
73 initFunction, flags) \
74{ USB_DEVICE_VER(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax), \
75 .driver_info = (flags) }
76
77static struct usb_device_id jumpshot_usb_ids[] = {
78# include "unusual_jumpshot.h"
79 { }
80};
81MODULE_DEVICE_TABLE(usb, jumpshot_usb_ids);
82
83#undef UNUSUAL_DEV
84
85
86
87
88#define UNUSUAL_DEV(idVendor, idProduct, bcdDeviceMin, bcdDeviceMax, \
89 vendor_name, product_name, use_protocol, use_transport, \
90 init_function, Flags) \
91{ \
92 .vendorName = vendor_name, \
93 .productName = product_name, \
94 .useProtocol = use_protocol, \
95 .useTransport = use_transport, \
96 .initFunction = init_function, \
97}
98
99static struct us_unusual_dev jumpshot_unusual_dev_list[] = {
100# include "unusual_jumpshot.h"
101 { }
102};
103
104#undef UNUSUAL_DEV
105
106
107struct jumpshot_info {
108 unsigned long sectors;
109 unsigned long ssize;
110
111
112 unsigned char sense_key;
113 unsigned long sense_asc;
114 unsigned long sense_ascq;
115};
116
117static inline int jumpshot_bulk_read(struct us_data *us,
118 unsigned char *data,
119 unsigned int len)
120{
121 if (len == 0)
122 return USB_STOR_XFER_GOOD;
123
124 usb_stor_dbg(us, "len = %d\n", len);
125 return usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,
126 data, len, NULL);
127}
128
129
130static inline int jumpshot_bulk_write(struct us_data *us,
131 unsigned char *data,
132 unsigned int len)
133{
134 if (len == 0)
135 return USB_STOR_XFER_GOOD;
136
137 usb_stor_dbg(us, "len = %d\n", len);
138 return usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,
139 data, len, NULL);
140}
141
142
143static int jumpshot_get_status(struct us_data *us)
144{
145 int rc;
146
147 if (!us)
148 return USB_STOR_TRANSPORT_ERROR;
149
150
151 rc = usb_stor_ctrl_transfer(us, us->recv_ctrl_pipe,
152 0, 0xA0, 0, 7, us->iobuf, 1);
153
154 if (rc != USB_STOR_XFER_GOOD)
155 return USB_STOR_TRANSPORT_ERROR;
156
157 if (us->iobuf[0] != 0x50) {
158 usb_stor_dbg(us, "0x%2x\n", us->iobuf[0]);
159 return USB_STOR_TRANSPORT_ERROR;
160 }
161
162 return USB_STOR_TRANSPORT_GOOD;
163}
164
165static int jumpshot_read_data(struct us_data *us,
166 struct jumpshot_info *info,
167 u32 sector,
168 u32 sectors)
169{
170 unsigned char *command = us->iobuf;
171 unsigned char *buffer;
172 unsigned char thistime;
173 unsigned int totallen, alloclen;
174 int len, result;
175 unsigned int sg_offset = 0;
176 struct scatterlist *sg = NULL;
177
178
179
180
181
182
183 if (sector > 0x0FFFFFFF)
184 return USB_STOR_TRANSPORT_ERROR;
185
186 totallen = sectors * info->ssize;
187
188
189
190
191
192 alloclen = min(totallen, 65536u);
193 buffer = kmalloc(alloclen, GFP_NOIO);
194 if (buffer == NULL)
195 return USB_STOR_TRANSPORT_ERROR;
196
197 do {
198
199
200 len = min(totallen, alloclen);
201 thistime = (len / info->ssize) & 0xff;
202
203 command[0] = 0;
204 command[1] = thistime;
205 command[2] = sector & 0xFF;
206 command[3] = (sector >> 8) & 0xFF;
207 command[4] = (sector >> 16) & 0xFF;
208
209 command[5] = 0xE0 | ((sector >> 24) & 0x0F);
210 command[6] = 0x20;
211
212
213 result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
214 0, 0x20, 0, 1, command, 7);
215 if (result != USB_STOR_XFER_GOOD)
216 goto leave;
217
218
219 result = jumpshot_bulk_read(us, buffer, len);
220 if (result != USB_STOR_XFER_GOOD)
221 goto leave;
222
223 usb_stor_dbg(us, "%d bytes\n", len);
224
225
226 usb_stor_access_xfer_buf(buffer, len, us->srb,
227 &sg, &sg_offset, TO_XFER_BUF);
228
229 sector += thistime;
230 totallen -= len;
231 } while (totallen > 0);
232
233 kfree(buffer);
234 return USB_STOR_TRANSPORT_GOOD;
235
236 leave:
237 kfree(buffer);
238 return USB_STOR_TRANSPORT_ERROR;
239}
240
241
242static int jumpshot_write_data(struct us_data *us,
243 struct jumpshot_info *info,
244 u32 sector,
245 u32 sectors)
246{
247 unsigned char *command = us->iobuf;
248 unsigned char *buffer;
249 unsigned char thistime;
250 unsigned int totallen, alloclen;
251 int len, result, waitcount;
252 unsigned int sg_offset = 0;
253 struct scatterlist *sg = NULL;
254
255
256
257
258
259
260 if (sector > 0x0FFFFFFF)
261 return USB_STOR_TRANSPORT_ERROR;
262
263 totallen = sectors * info->ssize;
264
265
266
267
268
269 alloclen = min(totallen, 65536u);
270 buffer = kmalloc(alloclen, GFP_NOIO);
271 if (buffer == NULL)
272 return USB_STOR_TRANSPORT_ERROR;
273
274 do {
275
276
277
278 len = min(totallen, alloclen);
279 thistime = (len / info->ssize) & 0xff;
280
281
282 usb_stor_access_xfer_buf(buffer, len, us->srb,
283 &sg, &sg_offset, FROM_XFER_BUF);
284
285 command[0] = 0;
286 command[1] = thistime;
287 command[2] = sector & 0xFF;
288 command[3] = (sector >> 8) & 0xFF;
289 command[4] = (sector >> 16) & 0xFF;
290
291 command[5] = 0xE0 | ((sector >> 24) & 0x0F);
292 command[6] = 0x30;
293
294
295 result = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
296 0, 0x20, 0, 1, command, 7);
297 if (result != USB_STOR_XFER_GOOD)
298 goto leave;
299
300
301 result = jumpshot_bulk_write(us, buffer, len);
302 if (result != USB_STOR_XFER_GOOD)
303 goto leave;
304
305
306
307
308 waitcount = 0;
309 do {
310 result = jumpshot_get_status(us);
311 if (result != USB_STOR_TRANSPORT_GOOD) {
312
313
314 msleep(50);
315 }
316 } while ((result != USB_STOR_TRANSPORT_GOOD) && (waitcount < 10));
317
318 if (result != USB_STOR_TRANSPORT_GOOD)
319 usb_stor_dbg(us, "Gah! Waitcount = 10. Bad write!?\n");
320
321 sector += thistime;
322 totallen -= len;
323 } while (totallen > 0);
324
325 kfree(buffer);
326 return result;
327
328 leave:
329 kfree(buffer);
330 return USB_STOR_TRANSPORT_ERROR;
331}
332
333static int jumpshot_id_device(struct us_data *us,
334 struct jumpshot_info *info)
335{
336 unsigned char *command = us->iobuf;
337 unsigned char *reply;
338 int rc;
339
340 if (!info)
341 return USB_STOR_TRANSPORT_ERROR;
342
343 command[0] = 0xE0;
344 command[1] = 0xEC;
345 reply = kmalloc(512, GFP_NOIO);
346 if (!reply)
347 return USB_STOR_TRANSPORT_ERROR;
348
349
350 rc = usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
351 0, 0x20, 0, 6, command, 2);
352
353 if (rc != USB_STOR_XFER_GOOD) {
354 usb_stor_dbg(us, "Gah! send_control for read_capacity failed\n");
355 rc = USB_STOR_TRANSPORT_ERROR;
356 goto leave;
357 }
358
359
360 rc = jumpshot_bulk_read(us, reply, 512);
361 if (rc != USB_STOR_XFER_GOOD) {
362 rc = USB_STOR_TRANSPORT_ERROR;
363 goto leave;
364 }
365
366 info->sectors = ((u32)(reply[117]) << 24) |
367 ((u32)(reply[116]) << 16) |
368 ((u32)(reply[115]) << 8) |
369 ((u32)(reply[114]) );
370
371 rc = USB_STOR_TRANSPORT_GOOD;
372
373 leave:
374 kfree(reply);
375 return rc;
376}
377
378static int jumpshot_handle_mode_sense(struct us_data *us,
379 struct scsi_cmnd * srb,
380 int sense_6)
381{
382 static unsigned char rw_err_page[12] = {
383 0x1, 0xA, 0x21, 1, 0, 0, 0, 0, 1, 0, 0, 0
384 };
385 static unsigned char cache_page[12] = {
386 0x8, 0xA, 0x1, 0, 0, 0, 0, 0, 0, 0, 0, 0
387 };
388 static unsigned char rbac_page[12] = {
389 0x1B, 0xA, 0, 0x81, 0, 0, 0, 0, 0, 0, 0, 0
390 };
391 static unsigned char timer_page[8] = {
392 0x1C, 0x6, 0, 0, 0, 0
393 };
394 unsigned char pc, page_code;
395 unsigned int i = 0;
396 struct jumpshot_info *info = (struct jumpshot_info *) (us->extra);
397 unsigned char *ptr = us->iobuf;
398
399 pc = srb->cmnd[2] >> 6;
400 page_code = srb->cmnd[2] & 0x3F;
401
402 switch (pc) {
403 case 0x0:
404 usb_stor_dbg(us, "Current values\n");
405 break;
406 case 0x1:
407 usb_stor_dbg(us, "Changeable values\n");
408 break;
409 case 0x2:
410 usb_stor_dbg(us, "Default values\n");
411 break;
412 case 0x3:
413 usb_stor_dbg(us, "Saves values\n");
414 break;
415 }
416
417 memset(ptr, 0, 8);
418 if (sense_6) {
419 ptr[2] = 0x00;
420 i = 4;
421 } else {
422 ptr[3] = 0x00;
423 i = 8;
424 }
425
426 switch (page_code) {
427 case 0x0:
428
429 info->sense_key = 0x05;
430 info->sense_asc = 0x24;
431 info->sense_ascq = 0x00;
432 return USB_STOR_TRANSPORT_FAILED;
433
434 case 0x1:
435 memcpy(ptr + i, rw_err_page, sizeof(rw_err_page));
436 i += sizeof(rw_err_page);
437 break;
438
439 case 0x8:
440 memcpy(ptr + i, cache_page, sizeof(cache_page));
441 i += sizeof(cache_page);
442 break;
443
444 case 0x1B:
445 memcpy(ptr + i, rbac_page, sizeof(rbac_page));
446 i += sizeof(rbac_page);
447 break;
448
449 case 0x1C:
450 memcpy(ptr + i, timer_page, sizeof(timer_page));
451 i += sizeof(timer_page);
452 break;
453
454 case 0x3F:
455 memcpy(ptr + i, timer_page, sizeof(timer_page));
456 i += sizeof(timer_page);
457 memcpy(ptr + i, rbac_page, sizeof(rbac_page));
458 i += sizeof(rbac_page);
459 memcpy(ptr + i, cache_page, sizeof(cache_page));
460 i += sizeof(cache_page);
461 memcpy(ptr + i, rw_err_page, sizeof(rw_err_page));
462 i += sizeof(rw_err_page);
463 break;
464 }
465
466 if (sense_6)
467 ptr[0] = i - 1;
468 else
469 ((__be16 *) ptr)[0] = cpu_to_be16(i - 2);
470 usb_stor_set_xfer_buf(ptr, i, srb);
471
472 return USB_STOR_TRANSPORT_GOOD;
473}
474
475
476static void jumpshot_info_destructor(void *extra)
477{
478
479
480}
481
482
483
484
485
486static int jumpshot_transport(struct scsi_cmnd *srb, struct us_data *us)
487{
488 struct jumpshot_info *info;
489 int rc;
490 unsigned long block, blocks;
491 unsigned char *ptr = us->iobuf;
492 static unsigned char inquiry_response[8] = {
493 0x00, 0x80, 0x00, 0x01, 0x1F, 0x00, 0x00, 0x00
494 };
495
496 if (!us->extra) {
497 us->extra = kzalloc(sizeof(struct jumpshot_info), GFP_NOIO);
498 if (!us->extra)
499 return USB_STOR_TRANSPORT_ERROR;
500
501 us->extra_destructor = jumpshot_info_destructor;
502 }
503
504 info = (struct jumpshot_info *) (us->extra);
505
506 if (srb->cmnd[0] == INQUIRY) {
507 usb_stor_dbg(us, "INQUIRY - Returning bogus response\n");
508 memcpy(ptr, inquiry_response, sizeof(inquiry_response));
509 fill_inquiry_response(us, ptr, 36);
510 return USB_STOR_TRANSPORT_GOOD;
511 }
512
513 if (srb->cmnd[0] == READ_CAPACITY) {
514 info->ssize = 0x200;
515
516 rc = jumpshot_get_status(us);
517 if (rc != USB_STOR_TRANSPORT_GOOD)
518 return rc;
519
520 rc = jumpshot_id_device(us, info);
521 if (rc != USB_STOR_TRANSPORT_GOOD)
522 return rc;
523
524 usb_stor_dbg(us, "READ_CAPACITY: %ld sectors, %ld bytes per sector\n",
525 info->sectors, info->ssize);
526
527
528
529 ((__be32 *) ptr)[0] = cpu_to_be32(info->sectors - 1);
530 ((__be32 *) ptr)[1] = cpu_to_be32(info->ssize);
531 usb_stor_set_xfer_buf(ptr, 8, srb);
532
533 return USB_STOR_TRANSPORT_GOOD;
534 }
535
536 if (srb->cmnd[0] == MODE_SELECT_10) {
537 usb_stor_dbg(us, "Gah! MODE_SELECT_10\n");
538 return USB_STOR_TRANSPORT_ERROR;
539 }
540
541 if (srb->cmnd[0] == READ_10) {
542 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
543 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
544
545 blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
546
547 usb_stor_dbg(us, "READ_10: read block 0x%04lx count %ld\n",
548 block, blocks);
549 return jumpshot_read_data(us, info, block, blocks);
550 }
551
552 if (srb->cmnd[0] == READ_12) {
553
554
555 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
556 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
557
558 blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
559 ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
560
561 usb_stor_dbg(us, "READ_12: read block 0x%04lx count %ld\n",
562 block, blocks);
563 return jumpshot_read_data(us, info, block, blocks);
564 }
565
566 if (srb->cmnd[0] == WRITE_10) {
567 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
568 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
569
570 blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
571
572 usb_stor_dbg(us, "WRITE_10: write block 0x%04lx count %ld\n",
573 block, blocks);
574 return jumpshot_write_data(us, info, block, blocks);
575 }
576
577 if (srb->cmnd[0] == WRITE_12) {
578
579
580 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
581 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
582
583 blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
584 ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
585
586 usb_stor_dbg(us, "WRITE_12: write block 0x%04lx count %ld\n",
587 block, blocks);
588 return jumpshot_write_data(us, info, block, blocks);
589 }
590
591
592 if (srb->cmnd[0] == TEST_UNIT_READY) {
593 usb_stor_dbg(us, "TEST_UNIT_READY\n");
594 return jumpshot_get_status(us);
595 }
596
597 if (srb->cmnd[0] == REQUEST_SENSE) {
598 usb_stor_dbg(us, "REQUEST_SENSE\n");
599
600 memset(ptr, 0, 18);
601 ptr[0] = 0xF0;
602 ptr[2] = info->sense_key;
603 ptr[7] = 11;
604 ptr[12] = info->sense_asc;
605 ptr[13] = info->sense_ascq;
606 usb_stor_set_xfer_buf(ptr, 18, srb);
607
608 return USB_STOR_TRANSPORT_GOOD;
609 }
610
611 if (srb->cmnd[0] == MODE_SENSE) {
612 usb_stor_dbg(us, "MODE_SENSE_6 detected\n");
613 return jumpshot_handle_mode_sense(us, srb, 1);
614 }
615
616 if (srb->cmnd[0] == MODE_SENSE_10) {
617 usb_stor_dbg(us, "MODE_SENSE_10 detected\n");
618 return jumpshot_handle_mode_sense(us, srb, 0);
619 }
620
621 if (srb->cmnd[0] == ALLOW_MEDIUM_REMOVAL) {
622
623
624
625
626 return USB_STOR_TRANSPORT_GOOD;
627 }
628
629 if (srb->cmnd[0] == START_STOP) {
630
631
632
633
634 usb_stor_dbg(us, "START_STOP\n");
635
636
637
638
639 rc = jumpshot_id_device(us, info);
640 if (rc == USB_STOR_TRANSPORT_GOOD) {
641 info->sense_key = NO_SENSE;
642 srb->result = SUCCESS;
643 } else {
644 info->sense_key = UNIT_ATTENTION;
645 srb->result = SAM_STAT_CHECK_CONDITION;
646 }
647 return rc;
648 }
649
650 usb_stor_dbg(us, "Gah! Unknown command: %d (0x%x)\n",
651 srb->cmnd[0], srb->cmnd[0]);
652 info->sense_key = 0x05;
653 info->sense_asc = 0x20;
654 info->sense_ascq = 0x00;
655 return USB_STOR_TRANSPORT_FAILED;
656}
657
658static struct scsi_host_template jumpshot_host_template;
659
660static int jumpshot_probe(struct usb_interface *intf,
661 const struct usb_device_id *id)
662{
663 struct us_data *us;
664 int result;
665
666 result = usb_stor_probe1(&us, intf, id,
667 (id - jumpshot_usb_ids) + jumpshot_unusual_dev_list,
668 &jumpshot_host_template);
669 if (result)
670 return result;
671
672 us->transport_name = "Lexar Jumpshot Control/Bulk";
673 us->transport = jumpshot_transport;
674 us->transport_reset = usb_stor_Bulk_reset;
675 us->max_lun = 1;
676
677 result = usb_stor_probe2(us);
678 return result;
679}
680
681static struct usb_driver jumpshot_driver = {
682 .name = DRV_NAME,
683 .probe = jumpshot_probe,
684 .disconnect = usb_stor_disconnect,
685 .suspend = usb_stor_suspend,
686 .resume = usb_stor_resume,
687 .reset_resume = usb_stor_reset_resume,
688 .pre_reset = usb_stor_pre_reset,
689 .post_reset = usb_stor_post_reset,
690 .id_table = jumpshot_usb_ids,
691 .soft_unbind = 1,
692 .no_dynamic_id = 1,
693};
694
695module_usb_stor_driver(jumpshot_driver, jumpshot_host_template, DRV_NAME);
696