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#include <linux/errno.h>
46#include <linux/module.h>
47#include <linux/slab.h>
48#include <linux/cdrom.h>
49
50#include <scsi/scsi.h>
51#include <scsi/scsi_cmnd.h>
52
53#include "usb.h"
54#include "transport.h"
55#include "protocol.h"
56#include "debug.h"
57#include "scsiglue.h"
58
59#define DRV_NAME "ums-usbat"
60
61MODULE_DESCRIPTION("Driver for SCM Microsystems (a.k.a. Shuttle) USB-ATAPI cable");
62MODULE_AUTHOR("Daniel Drake <dsd@gentoo.org>, Robert Baruch <autophile@starband.net>");
63MODULE_LICENSE("GPL");
64
65
66#define USBAT_DEV_HP8200 0x01
67#define USBAT_DEV_FLASH 0x02
68
69#define USBAT_EPP_PORT 0x10
70#define USBAT_EPP_REGISTER 0x30
71#define USBAT_ATA 0x40
72#define USBAT_ISA 0x50
73
74
75#define USBAT_CMD_READ_REG 0x00
76#define USBAT_CMD_WRITE_REG 0x01
77#define USBAT_CMD_READ_BLOCK 0x02
78#define USBAT_CMD_WRITE_BLOCK 0x03
79#define USBAT_CMD_COND_READ_BLOCK 0x04
80#define USBAT_CMD_COND_WRITE_BLOCK 0x05
81#define USBAT_CMD_WRITE_REGS 0x07
82
83
84#define USBAT_CMD_EXEC_CMD 0x80
85#define USBAT_CMD_SET_FEAT 0x81
86#define USBAT_CMD_UIO 0x82
87
88
89#define USBAT_UIO_READ 1
90#define USBAT_UIO_WRITE 0
91
92
93#define USBAT_QUAL_FCQ 0x20
94#define USBAT_QUAL_ALQ 0x10
95
96
97#define USBAT_FLASH_MEDIA_NONE 0
98#define USBAT_FLASH_MEDIA_CF 1
99
100
101#define USBAT_FLASH_MEDIA_SAME 0
102#define USBAT_FLASH_MEDIA_CHANGED 1
103
104
105#define USBAT_ATA_DATA 0x10
106#define USBAT_ATA_FEATURES 0x11
107#define USBAT_ATA_ERROR 0x11
108#define USBAT_ATA_SECCNT 0x12
109#define USBAT_ATA_SECNUM 0x13
110#define USBAT_ATA_LBA_ME 0x14
111#define USBAT_ATA_LBA_HI 0x15
112#define USBAT_ATA_DEVICE 0x16
113#define USBAT_ATA_STATUS 0x17
114#define USBAT_ATA_CMD 0x17
115#define USBAT_ATA_ALTSTATUS 0x0E
116
117
118#define USBAT_UIO_EPAD 0x80
119#define USBAT_UIO_CDT 0x40
120
121#define USBAT_UIO_1 0x20
122#define USBAT_UIO_0 0x10
123#define USBAT_UIO_EPP_ATA 0x08
124#define USBAT_UIO_UI1 0x04
125#define USBAT_UIO_UI0 0x02
126#define USBAT_UIO_INTR_ACK 0x01
127
128
129#define USBAT_UIO_DRVRST 0x80
130#define USBAT_UIO_ACKD 0x40
131#define USBAT_UIO_OE1 0x20
132
133#define USBAT_UIO_OE0 0x10
134#define USBAT_UIO_ADPRST 0x01
135
136
137#define USBAT_FEAT_ETEN 0x80
138#define USBAT_FEAT_U1 0x08
139#define USBAT_FEAT_U0 0x04
140#define USBAT_FEAT_ET1 0x02
141#define USBAT_FEAT_ET2 0x01
142
143struct usbat_info {
144 int devicetype;
145
146
147 unsigned long sectors;
148 unsigned long ssize;
149
150 unsigned char sense_key;
151 unsigned long sense_asc;
152 unsigned long sense_ascq;
153};
154
155#define short_pack(LSB,MSB) ( ((u16)(LSB)) | ( ((u16)(MSB))<<8 ) )
156#define LSB_of(s) ((s)&0xFF)
157#define MSB_of(s) ((s)>>8)
158
159static int transferred = 0;
160
161static int usbat_flash_transport(struct scsi_cmnd * srb, struct us_data *us);
162static int usbat_hp8200e_transport(struct scsi_cmnd *srb, struct us_data *us);
163
164static int init_usbat_cd(struct us_data *us);
165static int init_usbat_flash(struct us_data *us);
166
167
168
169
170
171#define UNUSUAL_DEV(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax, \
172 vendorName, productName, useProtocol, useTransport, \
173 initFunction, flags) \
174{ USB_DEVICE_VER(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax), \
175 .driver_info = (flags) }
176
177static struct usb_device_id usbat_usb_ids[] = {
178# include "unusual_usbat.h"
179 { }
180};
181MODULE_DEVICE_TABLE(usb, usbat_usb_ids);
182
183#undef UNUSUAL_DEV
184
185
186
187
188#define UNUSUAL_DEV(idVendor, idProduct, bcdDeviceMin, bcdDeviceMax, \
189 vendor_name, product_name, use_protocol, use_transport, \
190 init_function, Flags) \
191{ \
192 .vendorName = vendor_name, \
193 .productName = product_name, \
194 .useProtocol = use_protocol, \
195 .useTransport = use_transport, \
196 .initFunction = init_function, \
197}
198
199static struct us_unusual_dev usbat_unusual_dev_list[] = {
200# include "unusual_usbat.h"
201 { }
202};
203
204#undef UNUSUAL_DEV
205
206
207
208
209
210static void usbat_pack_ata_sector_cmd(unsigned char *buf,
211 unsigned char thistime,
212 u32 sector, unsigned char cmd)
213{
214 buf[0] = 0;
215 buf[1] = thistime;
216 buf[2] = sector & 0xFF;
217 buf[3] = (sector >> 8) & 0xFF;
218 buf[4] = (sector >> 16) & 0xFF;
219 buf[5] = 0xE0 | ((sector >> 24) & 0x0F);
220 buf[6] = cmd;
221}
222
223
224
225
226static int usbat_get_device_type(struct us_data *us)
227{
228 return ((struct usbat_info*)us->extra)->devicetype;
229}
230
231
232
233
234static int usbat_read(struct us_data *us,
235 unsigned char access,
236 unsigned char reg,
237 unsigned char *content)
238{
239 return usb_stor_ctrl_transfer(us,
240 us->recv_ctrl_pipe,
241 access | USBAT_CMD_READ_REG,
242 0xC0,
243 (u16)reg,
244 0,
245 content,
246 1);
247}
248
249
250
251
252static int usbat_write(struct us_data *us,
253 unsigned char access,
254 unsigned char reg,
255 unsigned char content)
256{
257 return usb_stor_ctrl_transfer(us,
258 us->send_ctrl_pipe,
259 access | USBAT_CMD_WRITE_REG,
260 0x40,
261 short_pack(reg, content),
262 0,
263 NULL,
264 0);
265}
266
267
268
269
270static int usbat_bulk_read(struct us_data *us,
271 void* buf,
272 unsigned int len,
273 int use_sg)
274{
275 if (len == 0)
276 return USB_STOR_XFER_GOOD;
277
278 usb_stor_dbg(us, "len = %d\n", len);
279 return usb_stor_bulk_transfer_sg(us, us->recv_bulk_pipe, buf, len, use_sg, NULL);
280}
281
282
283
284
285static int usbat_bulk_write(struct us_data *us,
286 void* buf,
287 unsigned int len,
288 int use_sg)
289{
290 if (len == 0)
291 return USB_STOR_XFER_GOOD;
292
293 usb_stor_dbg(us, "len = %d\n", len);
294 return usb_stor_bulk_transfer_sg(us, us->send_bulk_pipe, buf, len, use_sg, NULL);
295}
296
297
298
299
300
301
302static int usbat_execute_command(struct us_data *us,
303 unsigned char *commands,
304 unsigned int len)
305{
306 return usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
307 USBAT_CMD_EXEC_CMD, 0x40, 0, 0,
308 commands, len);
309}
310
311
312
313
314static int usbat_get_status(struct us_data *us, unsigned char *status)
315{
316 int rc;
317 rc = usbat_read(us, USBAT_ATA, USBAT_ATA_STATUS, status);
318
319 usb_stor_dbg(us, "0x%02X\n", *status);
320 return rc;
321}
322
323
324
325
326static int usbat_check_status(struct us_data *us)
327{
328 unsigned char *reply = us->iobuf;
329 int rc;
330
331 rc = usbat_get_status(us, reply);
332 if (rc != USB_STOR_XFER_GOOD)
333 return USB_STOR_TRANSPORT_FAILED;
334
335
336 if (*reply & 0x01 && *reply != 0x51)
337 return USB_STOR_TRANSPORT_FAILED;
338
339
340 if (*reply & 0x20)
341 return USB_STOR_TRANSPORT_FAILED;
342
343 return USB_STOR_TRANSPORT_GOOD;
344}
345
346
347
348
349
350static int usbat_set_shuttle_features(struct us_data *us,
351 unsigned char external_trigger,
352 unsigned char epp_control,
353 unsigned char mask_byte,
354 unsigned char test_pattern,
355 unsigned char subcountH,
356 unsigned char subcountL)
357{
358 unsigned char *command = us->iobuf;
359
360 command[0] = 0x40;
361 command[1] = USBAT_CMD_SET_FEAT;
362
363
364
365
366
367 command[2] = epp_control;
368
369
370
371
372
373
374
375 command[3] = external_trigger;
376
377
378
379
380
381
382 command[4] = test_pattern;
383
384
385
386
387
388 command[5] = mask_byte;
389
390
391
392
393
394
395
396 command[6] = subcountL;
397 command[7] = subcountH;
398
399 return usbat_execute_command(us, command, 8);
400}
401
402
403
404
405
406static int usbat_wait_not_busy(struct us_data *us, int minutes)
407{
408 int i;
409 int result;
410 unsigned char *status = us->iobuf;
411
412
413
414
415
416
417
418
419 for (i=0; i<1200+minutes*60; i++) {
420
421 result = usbat_get_status(us, status);
422
423 if (result!=USB_STOR_XFER_GOOD)
424 return USB_STOR_TRANSPORT_ERROR;
425 if (*status & 0x01) {
426 result = usbat_read(us, USBAT_ATA, 0x10, status);
427 return USB_STOR_TRANSPORT_FAILED;
428 }
429 if (*status & 0x20)
430 return USB_STOR_TRANSPORT_FAILED;
431
432 if ((*status & 0x80)==0x00) {
433 usb_stor_dbg(us, "Waited not busy for %d steps\n", i);
434 return USB_STOR_TRANSPORT_GOOD;
435 }
436
437 if (i<500)
438 msleep(10);
439 else if (i<700)
440 msleep(50);
441 else if (i<1200)
442 msleep(100);
443 else
444 msleep(1000);
445 }
446
447 usb_stor_dbg(us, "Waited not busy for %d minutes, timing out\n",
448 minutes);
449 return USB_STOR_TRANSPORT_FAILED;
450}
451
452
453
454
455static int usbat_read_block(struct us_data *us,
456 void* buf,
457 unsigned short len,
458 int use_sg)
459{
460 int result;
461 unsigned char *command = us->iobuf;
462
463 if (!len)
464 return USB_STOR_TRANSPORT_GOOD;
465
466 command[0] = 0xC0;
467 command[1] = USBAT_ATA | USBAT_CMD_READ_BLOCK;
468 command[2] = USBAT_ATA_DATA;
469 command[3] = 0;
470 command[4] = 0;
471 command[5] = 0;
472 command[6] = LSB_of(len);
473 command[7] = MSB_of(len);
474
475 result = usbat_execute_command(us, command, 8);
476 if (result != USB_STOR_XFER_GOOD)
477 return USB_STOR_TRANSPORT_ERROR;
478
479 result = usbat_bulk_read(us, buf, len, use_sg);
480 return (result == USB_STOR_XFER_GOOD ?
481 USB_STOR_TRANSPORT_GOOD : USB_STOR_TRANSPORT_ERROR);
482}
483
484
485
486
487static int usbat_write_block(struct us_data *us,
488 unsigned char access,
489 void* buf,
490 unsigned short len,
491 int minutes,
492 int use_sg)
493{
494 int result;
495 unsigned char *command = us->iobuf;
496
497 if (!len)
498 return USB_STOR_TRANSPORT_GOOD;
499
500 command[0] = 0x40;
501 command[1] = access | USBAT_CMD_WRITE_BLOCK;
502 command[2] = USBAT_ATA_DATA;
503 command[3] = 0;
504 command[4] = 0;
505 command[5] = 0;
506 command[6] = LSB_of(len);
507 command[7] = MSB_of(len);
508
509 result = usbat_execute_command(us, command, 8);
510
511 if (result != USB_STOR_XFER_GOOD)
512 return USB_STOR_TRANSPORT_ERROR;
513
514 result = usbat_bulk_write(us, buf, len, use_sg);
515 if (result != USB_STOR_XFER_GOOD)
516 return USB_STOR_TRANSPORT_ERROR;
517
518 return usbat_wait_not_busy(us, minutes);
519}
520
521
522
523
524static int usbat_hp8200e_rw_block_test(struct us_data *us,
525 unsigned char access,
526 unsigned char *registers,
527 unsigned char *data_out,
528 unsigned short num_registers,
529 unsigned char data_reg,
530 unsigned char status_reg,
531 unsigned char timeout,
532 unsigned char qualifier,
533 int direction,
534 void *buf,
535 unsigned short len,
536 int use_sg,
537 int minutes)
538{
539 int result;
540 unsigned int pipe = (direction == DMA_FROM_DEVICE) ?
541 us->recv_bulk_pipe : us->send_bulk_pipe;
542
543 unsigned char *command = us->iobuf;
544 int i, j;
545 int cmdlen;
546 unsigned char *data = us->iobuf;
547 unsigned char *status = us->iobuf;
548
549 BUG_ON(num_registers > US_IOBUF_SIZE/2);
550
551 for (i=0; i<20; i++) {
552
553
554
555
556
557
558
559
560
561
562
563
564 if (i==0) {
565 cmdlen = 16;
566
567
568
569
570
571
572 command[0] = 0x40;
573 command[1] = access | USBAT_CMD_WRITE_REGS;
574 command[2] = 0x07;
575 command[3] = 0x17;
576 command[4] = 0xFC;
577 command[5] = 0xE7;
578 command[6] = LSB_of(num_registers*2);
579 command[7] = MSB_of(num_registers*2);
580 } else
581 cmdlen = 8;
582
583
584 command[cmdlen-8] = (direction==DMA_TO_DEVICE ? 0x40 : 0xC0);
585 command[cmdlen-7] = access |
586 (direction==DMA_TO_DEVICE ?
587 USBAT_CMD_COND_WRITE_BLOCK : USBAT_CMD_COND_READ_BLOCK);
588 command[cmdlen-6] = data_reg;
589 command[cmdlen-5] = status_reg;
590 command[cmdlen-4] = timeout;
591 command[cmdlen-3] = qualifier;
592 command[cmdlen-2] = LSB_of(len);
593 command[cmdlen-1] = MSB_of(len);
594
595 result = usbat_execute_command(us, command, cmdlen);
596
597 if (result != USB_STOR_XFER_GOOD)
598 return USB_STOR_TRANSPORT_ERROR;
599
600 if (i==0) {
601
602 for (j=0; j<num_registers; j++) {
603 data[j<<1] = registers[j];
604 data[1+(j<<1)] = data_out[j];
605 }
606
607 result = usbat_bulk_write(us, data, num_registers*2, 0);
608 if (result != USB_STOR_XFER_GOOD)
609 return USB_STOR_TRANSPORT_ERROR;
610
611 }
612
613 result = usb_stor_bulk_transfer_sg(us,
614 pipe, buf, len, use_sg, NULL);
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635 if (result == USB_STOR_XFER_SHORT ||
636 result == USB_STOR_XFER_STALLED) {
637
638
639
640
641
642
643 if (direction==DMA_FROM_DEVICE && i==0) {
644 if (usb_stor_clear_halt(us,
645 us->send_bulk_pipe) < 0)
646 return USB_STOR_TRANSPORT_ERROR;
647 }
648
649
650
651
652
653 result = usbat_read(us, USBAT_ATA,
654 direction==DMA_TO_DEVICE ?
655 USBAT_ATA_STATUS : USBAT_ATA_ALTSTATUS,
656 status);
657
658 if (result!=USB_STOR_XFER_GOOD)
659 return USB_STOR_TRANSPORT_ERROR;
660 if (*status & 0x01)
661 return USB_STOR_TRANSPORT_FAILED;
662 if (*status & 0x20)
663 return USB_STOR_TRANSPORT_FAILED;
664
665 usb_stor_dbg(us, "Redoing %s\n",
666 direction == DMA_TO_DEVICE
667 ? "write" : "read");
668
669 } else if (result != USB_STOR_XFER_GOOD)
670 return USB_STOR_TRANSPORT_ERROR;
671 else
672 return usbat_wait_not_busy(us, minutes);
673
674 }
675
676 usb_stor_dbg(us, "Bummer! %s bulk data 20 times failed\n",
677 direction == DMA_TO_DEVICE ? "Writing" : "Reading");
678
679 return USB_STOR_TRANSPORT_FAILED;
680}
681
682
683
684
685
686
687
688
689static int usbat_multiple_write(struct us_data *us,
690 unsigned char *registers,
691 unsigned char *data_out,
692 unsigned short num_registers)
693{
694 int i, result;
695 unsigned char *data = us->iobuf;
696 unsigned char *command = us->iobuf;
697
698 BUG_ON(num_registers > US_IOBUF_SIZE/2);
699
700
701 command[0] = 0x40;
702 command[1] = USBAT_ATA | USBAT_CMD_WRITE_REGS;
703
704
705 command[2] = 0;
706 command[3] = 0;
707 command[4] = 0;
708 command[5] = 0;
709
710
711 command[6] = LSB_of(num_registers*2);
712 command[7] = MSB_of(num_registers*2);
713
714
715 result = usbat_execute_command(us, command, 8);
716 if (result != USB_STOR_XFER_GOOD)
717 return USB_STOR_TRANSPORT_ERROR;
718
719
720 for (i=0; i<num_registers; i++) {
721 data[i<<1] = registers[i];
722 data[1+(i<<1)] = data_out[i];
723 }
724
725
726 result = usbat_bulk_write(us, data, num_registers*2, 0);
727 if (result != USB_STOR_XFER_GOOD)
728 return USB_STOR_TRANSPORT_ERROR;
729
730 if (usbat_get_device_type(us) == USBAT_DEV_HP8200)
731 return usbat_wait_not_busy(us, 0);
732 else
733 return USB_STOR_TRANSPORT_GOOD;
734}
735
736
737
738
739
740
741
742
743
744
745
746
747
748static int usbat_read_blocks(struct us_data *us,
749 void* buffer,
750 int len,
751 int use_sg)
752{
753 int result;
754 unsigned char *command = us->iobuf;
755
756 command[0] = 0xC0;
757 command[1] = USBAT_ATA | USBAT_CMD_COND_READ_BLOCK;
758 command[2] = USBAT_ATA_DATA;
759 command[3] = USBAT_ATA_STATUS;
760 command[4] = 0xFD;
761 command[5] = USBAT_QUAL_FCQ;
762 command[6] = LSB_of(len);
763 command[7] = MSB_of(len);
764
765
766 result = usbat_execute_command(us, command, 8);
767 if (result != USB_STOR_XFER_GOOD)
768 return USB_STOR_TRANSPORT_FAILED;
769
770
771 result = usbat_bulk_read(us, buffer, len, use_sg);
772 if (result != USB_STOR_XFER_GOOD)
773 return USB_STOR_TRANSPORT_FAILED;
774
775 return USB_STOR_TRANSPORT_GOOD;
776}
777
778
779
780
781
782
783
784
785
786
787
788
789
790static int usbat_write_blocks(struct us_data *us,
791 void* buffer,
792 int len,
793 int use_sg)
794{
795 int result;
796 unsigned char *command = us->iobuf;
797
798 command[0] = 0x40;
799 command[1] = USBAT_ATA | USBAT_CMD_COND_WRITE_BLOCK;
800 command[2] = USBAT_ATA_DATA;
801 command[3] = USBAT_ATA_STATUS;
802 command[4] = 0xFD;
803 command[5] = USBAT_QUAL_FCQ;
804 command[6] = LSB_of(len);
805 command[7] = MSB_of(len);
806
807
808 result = usbat_execute_command(us, command, 8);
809 if (result != USB_STOR_XFER_GOOD)
810 return USB_STOR_TRANSPORT_FAILED;
811
812
813 result = usbat_bulk_write(us, buffer, len, use_sg);
814 if (result != USB_STOR_XFER_GOOD)
815 return USB_STOR_TRANSPORT_FAILED;
816
817 return USB_STOR_TRANSPORT_GOOD;
818}
819
820
821
822
823static int usbat_read_user_io(struct us_data *us, unsigned char *data_flags)
824{
825 int result;
826
827 result = usb_stor_ctrl_transfer(us,
828 us->recv_ctrl_pipe,
829 USBAT_CMD_UIO,
830 0xC0,
831 0,
832 0,
833 data_flags,
834 USBAT_UIO_READ);
835
836 usb_stor_dbg(us, "UIO register reads %02X\n", *data_flags);
837
838 return result;
839}
840
841
842
843
844static int usbat_write_user_io(struct us_data *us,
845 unsigned char enable_flags,
846 unsigned char data_flags)
847{
848 return usb_stor_ctrl_transfer(us,
849 us->send_ctrl_pipe,
850 USBAT_CMD_UIO,
851 0x40,
852 short_pack(enable_flags, data_flags),
853 0,
854 NULL,
855 USBAT_UIO_WRITE);
856}
857
858
859
860
861
862static int usbat_device_reset(struct us_data *us)
863{
864 int rc;
865
866
867
868
869
870 rc = usbat_write_user_io(us,
871 USBAT_UIO_DRVRST | USBAT_UIO_OE1 | USBAT_UIO_OE0,
872 USBAT_UIO_EPAD | USBAT_UIO_1);
873 if (rc != USB_STOR_XFER_GOOD)
874 return USB_STOR_TRANSPORT_ERROR;
875
876
877
878
879
880 rc = usbat_write_user_io(us,
881 USBAT_UIO_OE1 | USBAT_UIO_OE0,
882 USBAT_UIO_EPAD | USBAT_UIO_1);
883 if (rc != USB_STOR_XFER_GOOD)
884 return USB_STOR_TRANSPORT_ERROR;
885
886 return USB_STOR_TRANSPORT_GOOD;
887}
888
889
890
891
892static int usbat_device_enable_cdt(struct us_data *us)
893{
894 int rc;
895
896
897 rc = usbat_write_user_io(us,
898 USBAT_UIO_ACKD | USBAT_UIO_OE1 | USBAT_UIO_OE0,
899 USBAT_UIO_EPAD | USBAT_UIO_1);
900 if (rc != USB_STOR_XFER_GOOD)
901 return USB_STOR_TRANSPORT_ERROR;
902
903 return USB_STOR_TRANSPORT_GOOD;
904}
905
906
907
908
909static int usbat_flash_check_media_present(struct us_data *us,
910 unsigned char *uio)
911{
912 if (*uio & USBAT_UIO_UI0) {
913 usb_stor_dbg(us, "no media detected\n");
914 return USBAT_FLASH_MEDIA_NONE;
915 }
916
917 return USBAT_FLASH_MEDIA_CF;
918}
919
920
921
922
923static int usbat_flash_check_media_changed(struct us_data *us,
924 unsigned char *uio)
925{
926 if (*uio & USBAT_UIO_0) {
927 usb_stor_dbg(us, "media change detected\n");
928 return USBAT_FLASH_MEDIA_CHANGED;
929 }
930
931 return USBAT_FLASH_MEDIA_SAME;
932}
933
934
935
936
937static int usbat_flash_check_media(struct us_data *us,
938 struct usbat_info *info)
939{
940 int rc;
941 unsigned char *uio = us->iobuf;
942
943 rc = usbat_read_user_io(us, uio);
944 if (rc != USB_STOR_XFER_GOOD)
945 return USB_STOR_TRANSPORT_ERROR;
946
947
948 rc = usbat_flash_check_media_present(us, uio);
949 if (rc == USBAT_FLASH_MEDIA_NONE) {
950 info->sense_key = 0x02;
951 info->sense_asc = 0x3A;
952 info->sense_ascq = 0x00;
953 return USB_STOR_TRANSPORT_FAILED;
954 }
955
956
957 rc = usbat_flash_check_media_changed(us, uio);
958 if (rc == USBAT_FLASH_MEDIA_CHANGED) {
959
960
961 rc = usbat_device_reset(us);
962 if (rc != USB_STOR_TRANSPORT_GOOD)
963 return rc;
964 rc = usbat_device_enable_cdt(us);
965 if (rc != USB_STOR_TRANSPORT_GOOD)
966 return rc;
967
968 msleep(50);
969
970 rc = usbat_read_user_io(us, uio);
971 if (rc != USB_STOR_XFER_GOOD)
972 return USB_STOR_TRANSPORT_ERROR;
973
974 info->sense_key = UNIT_ATTENTION;
975 info->sense_asc = 0x28;
976 info->sense_ascq = 0x00;
977 return USB_STOR_TRANSPORT_FAILED;
978 }
979
980 return USB_STOR_TRANSPORT_GOOD;
981}
982
983
984
985
986
987
988static int usbat_identify_device(struct us_data *us,
989 struct usbat_info *info)
990{
991 int rc;
992 unsigned char status;
993
994 if (!us || !info)
995 return USB_STOR_TRANSPORT_ERROR;
996
997 rc = usbat_device_reset(us);
998 if (rc != USB_STOR_TRANSPORT_GOOD)
999 return rc;
1000 msleep(500);
1001
1002
1003
1004
1005
1006
1007
1008 rc = usbat_write(us, USBAT_ATA, USBAT_ATA_CMD, 0xA1);
1009 if (rc != USB_STOR_XFER_GOOD)
1010 return USB_STOR_TRANSPORT_ERROR;
1011
1012 rc = usbat_get_status(us, &status);
1013 if (rc != USB_STOR_XFER_GOOD)
1014 return USB_STOR_TRANSPORT_ERROR;
1015
1016
1017 if (status == 0xA1 || !(status & 0x01)) {
1018
1019 usb_stor_dbg(us, "Detected HP8200 CDRW\n");
1020 info->devicetype = USBAT_DEV_HP8200;
1021 } else {
1022
1023 usb_stor_dbg(us, "Detected Flash reader/writer\n");
1024 info->devicetype = USBAT_DEV_FLASH;
1025 }
1026
1027 return USB_STOR_TRANSPORT_GOOD;
1028}
1029
1030
1031
1032
1033static int usbat_set_transport(struct us_data *us,
1034 struct usbat_info *info,
1035 int devicetype)
1036{
1037
1038 if (!info->devicetype)
1039 info->devicetype = devicetype;
1040
1041 if (!info->devicetype)
1042 usbat_identify_device(us, info);
1043
1044 switch (info->devicetype) {
1045 default:
1046 return USB_STOR_TRANSPORT_ERROR;
1047
1048 case USBAT_DEV_HP8200:
1049 us->transport = usbat_hp8200e_transport;
1050 break;
1051
1052 case USBAT_DEV_FLASH:
1053 us->transport = usbat_flash_transport;
1054 break;
1055 }
1056
1057 return 0;
1058}
1059
1060
1061
1062
1063static int usbat_flash_get_sector_count(struct us_data *us,
1064 struct usbat_info *info)
1065{
1066 unsigned char registers[3] = {
1067 USBAT_ATA_SECCNT,
1068 USBAT_ATA_DEVICE,
1069 USBAT_ATA_CMD,
1070 };
1071 unsigned char command[3] = { 0x01, 0xA0, 0xEC };
1072 unsigned char *reply;
1073 unsigned char status;
1074 int rc;
1075
1076 if (!us || !info)
1077 return USB_STOR_TRANSPORT_ERROR;
1078
1079 reply = kmalloc(512, GFP_NOIO);
1080 if (!reply)
1081 return USB_STOR_TRANSPORT_ERROR;
1082
1083
1084 rc = usbat_multiple_write(us, registers, command, 3);
1085 if (rc != USB_STOR_XFER_GOOD) {
1086 usb_stor_dbg(us, "Gah! identify_device failed\n");
1087 rc = USB_STOR_TRANSPORT_ERROR;
1088 goto leave;
1089 }
1090
1091
1092 if (usbat_get_status(us, &status) != USB_STOR_XFER_GOOD) {
1093 rc = USB_STOR_TRANSPORT_ERROR;
1094 goto leave;
1095 }
1096
1097 msleep(100);
1098
1099
1100 rc = usbat_read_block(us, reply, 512, 0);
1101 if (rc != USB_STOR_TRANSPORT_GOOD)
1102 goto leave;
1103
1104 info->sectors = ((u32)(reply[117]) << 24) |
1105 ((u32)(reply[116]) << 16) |
1106 ((u32)(reply[115]) << 8) |
1107 ((u32)(reply[114]) );
1108
1109 rc = USB_STOR_TRANSPORT_GOOD;
1110
1111 leave:
1112 kfree(reply);
1113 return rc;
1114}
1115
1116
1117
1118
1119static int usbat_flash_read_data(struct us_data *us,
1120 struct usbat_info *info,
1121 u32 sector,
1122 u32 sectors)
1123{
1124 unsigned char registers[7] = {
1125 USBAT_ATA_FEATURES,
1126 USBAT_ATA_SECCNT,
1127 USBAT_ATA_SECNUM,
1128 USBAT_ATA_LBA_ME,
1129 USBAT_ATA_LBA_HI,
1130 USBAT_ATA_DEVICE,
1131 USBAT_ATA_STATUS,
1132 };
1133 unsigned char command[7];
1134 unsigned char *buffer;
1135 unsigned char thistime;
1136 unsigned int totallen, alloclen;
1137 int len, result;
1138 unsigned int sg_offset = 0;
1139 struct scatterlist *sg = NULL;
1140
1141 result = usbat_flash_check_media(us, info);
1142 if (result != USB_STOR_TRANSPORT_GOOD)
1143 return result;
1144
1145
1146
1147
1148
1149
1150
1151
1152 if (sector > 0x0FFFFFFF)
1153 return USB_STOR_TRANSPORT_ERROR;
1154
1155 totallen = sectors * info->ssize;
1156
1157
1158
1159
1160
1161
1162
1163 alloclen = min(totallen, 65536u);
1164 buffer = kmalloc(alloclen, GFP_NOIO);
1165 if (buffer == NULL)
1166 return USB_STOR_TRANSPORT_ERROR;
1167
1168 do {
1169
1170
1171
1172
1173 len = min(totallen, alloclen);
1174 thistime = (len / info->ssize) & 0xff;
1175
1176
1177 usbat_pack_ata_sector_cmd(command, thistime, sector, 0x20);
1178
1179
1180 result = usbat_multiple_write(us, registers, command, 7);
1181 if (result != USB_STOR_TRANSPORT_GOOD)
1182 goto leave;
1183
1184
1185 result = usbat_read_blocks(us, buffer, len, 0);
1186 if (result != USB_STOR_TRANSPORT_GOOD)
1187 goto leave;
1188
1189 usb_stor_dbg(us, "%d bytes\n", len);
1190
1191
1192 usb_stor_access_xfer_buf(buffer, len, us->srb,
1193 &sg, &sg_offset, TO_XFER_BUF);
1194
1195 sector += thistime;
1196 totallen -= len;
1197 } while (totallen > 0);
1198
1199 kfree(buffer);
1200 return USB_STOR_TRANSPORT_GOOD;
1201
1202leave:
1203 kfree(buffer);
1204 return USB_STOR_TRANSPORT_ERROR;
1205}
1206
1207
1208
1209
1210static int usbat_flash_write_data(struct us_data *us,
1211 struct usbat_info *info,
1212 u32 sector,
1213 u32 sectors)
1214{
1215 unsigned char registers[7] = {
1216 USBAT_ATA_FEATURES,
1217 USBAT_ATA_SECCNT,
1218 USBAT_ATA_SECNUM,
1219 USBAT_ATA_LBA_ME,
1220 USBAT_ATA_LBA_HI,
1221 USBAT_ATA_DEVICE,
1222 USBAT_ATA_STATUS,
1223 };
1224 unsigned char command[7];
1225 unsigned char *buffer;
1226 unsigned char thistime;
1227 unsigned int totallen, alloclen;
1228 int len, result;
1229 unsigned int sg_offset = 0;
1230 struct scatterlist *sg = NULL;
1231
1232 result = usbat_flash_check_media(us, info);
1233 if (result != USB_STOR_TRANSPORT_GOOD)
1234 return result;
1235
1236
1237
1238
1239
1240
1241
1242
1243 if (sector > 0x0FFFFFFF)
1244 return USB_STOR_TRANSPORT_ERROR;
1245
1246 totallen = sectors * info->ssize;
1247
1248
1249
1250
1251
1252
1253
1254 alloclen = min(totallen, 65536u);
1255 buffer = kmalloc(alloclen, GFP_NOIO);
1256 if (buffer == NULL)
1257 return USB_STOR_TRANSPORT_ERROR;
1258
1259 do {
1260
1261
1262
1263
1264 len = min(totallen, alloclen);
1265 thistime = (len / info->ssize) & 0xff;
1266
1267
1268 usb_stor_access_xfer_buf(buffer, len, us->srb,
1269 &sg, &sg_offset, FROM_XFER_BUF);
1270
1271
1272 usbat_pack_ata_sector_cmd(command, thistime, sector, 0x30);
1273
1274
1275 result = usbat_multiple_write(us, registers, command, 7);
1276 if (result != USB_STOR_TRANSPORT_GOOD)
1277 goto leave;
1278
1279
1280 result = usbat_write_blocks(us, buffer, len, 0);
1281 if (result != USB_STOR_TRANSPORT_GOOD)
1282 goto leave;
1283
1284 sector += thistime;
1285 totallen -= len;
1286 } while (totallen > 0);
1287
1288 kfree(buffer);
1289 return result;
1290
1291leave:
1292 kfree(buffer);
1293 return USB_STOR_TRANSPORT_ERROR;
1294}
1295
1296
1297
1298
1299
1300static int usbat_hp8200e_handle_read10(struct us_data *us,
1301 unsigned char *registers,
1302 unsigned char *data,
1303 struct scsi_cmnd *srb)
1304{
1305 int result = USB_STOR_TRANSPORT_GOOD;
1306 unsigned char *buffer;
1307 unsigned int len;
1308 unsigned int sector;
1309 unsigned int sg_offset = 0;
1310 struct scatterlist *sg = NULL;
1311
1312 usb_stor_dbg(us, "transfersize %d\n", srb->transfersize);
1313
1314 if (scsi_bufflen(srb) < 0x10000) {
1315
1316 result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
1317 registers, data, 19,
1318 USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
1319 (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
1320 DMA_FROM_DEVICE,
1321 scsi_sglist(srb),
1322 scsi_bufflen(srb), scsi_sg_count(srb), 1);
1323
1324 return result;
1325 }
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335 if (data[7+0] == GPCMD_READ_CD) {
1336 len = short_pack(data[7+9], data[7+8]);
1337 len <<= 16;
1338 len |= data[7+7];
1339 usb_stor_dbg(us, "GPCMD_READ_CD: len %d\n", len);
1340 srb->transfersize = scsi_bufflen(srb)/len;
1341 }
1342
1343 if (!srb->transfersize) {
1344 srb->transfersize = 2048;
1345 usb_stor_dbg(us, "transfersize 0, forcing %d\n",
1346 srb->transfersize);
1347 }
1348
1349
1350
1351
1352
1353
1354
1355 len = (65535/srb->transfersize) * srb->transfersize;
1356 usb_stor_dbg(us, "Max read is %d bytes\n", len);
1357 len = min(len, scsi_bufflen(srb));
1358 buffer = kmalloc(len, GFP_NOIO);
1359 if (buffer == NULL)
1360 return USB_STOR_TRANSPORT_FAILED;
1361 sector = short_pack(data[7+3], data[7+2]);
1362 sector <<= 16;
1363 sector |= short_pack(data[7+5], data[7+4]);
1364 transferred = 0;
1365
1366 while (transferred != scsi_bufflen(srb)) {
1367
1368 if (len > scsi_bufflen(srb) - transferred)
1369 len = scsi_bufflen(srb) - transferred;
1370
1371 data[3] = len&0xFF;
1372 data[4] = (len>>8)&0xFF;
1373
1374
1375
1376 data[7+2] = MSB_of(sector>>16);
1377 data[7+3] = LSB_of(sector>>16);
1378 data[7+4] = MSB_of(sector&0xFFFF);
1379 data[7+5] = LSB_of(sector&0xFFFF);
1380 if (data[7+0] == GPCMD_READ_CD)
1381 data[7+6] = 0;
1382 data[7+7] = MSB_of(len / srb->transfersize);
1383 data[7+8] = LSB_of(len / srb->transfersize);
1384
1385 result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
1386 registers, data, 19,
1387 USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
1388 (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
1389 DMA_FROM_DEVICE,
1390 buffer,
1391 len, 0, 1);
1392
1393 if (result != USB_STOR_TRANSPORT_GOOD)
1394 break;
1395
1396
1397 usb_stor_access_xfer_buf(buffer, len, srb,
1398 &sg, &sg_offset, TO_XFER_BUF);
1399
1400
1401
1402 transferred += len;
1403 sector += len / srb->transfersize;
1404
1405 }
1406
1407 kfree(buffer);
1408 return result;
1409}
1410
1411static int usbat_select_and_test_registers(struct us_data *us)
1412{
1413 int selector;
1414 unsigned char *status = us->iobuf;
1415
1416
1417 for (selector = 0xA0; selector <= 0xB0; selector += 0x10) {
1418 if (usbat_write(us, USBAT_ATA, USBAT_ATA_DEVICE, selector) !=
1419 USB_STOR_XFER_GOOD)
1420 return USB_STOR_TRANSPORT_ERROR;
1421
1422 if (usbat_read(us, USBAT_ATA, USBAT_ATA_STATUS, status) !=
1423 USB_STOR_XFER_GOOD)
1424 return USB_STOR_TRANSPORT_ERROR;
1425
1426 if (usbat_read(us, USBAT_ATA, USBAT_ATA_DEVICE, status) !=
1427 USB_STOR_XFER_GOOD)
1428 return USB_STOR_TRANSPORT_ERROR;
1429
1430 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
1431 USB_STOR_XFER_GOOD)
1432 return USB_STOR_TRANSPORT_ERROR;
1433
1434 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_HI, status) !=
1435 USB_STOR_XFER_GOOD)
1436 return USB_STOR_TRANSPORT_ERROR;
1437
1438 if (usbat_write(us, USBAT_ATA, USBAT_ATA_LBA_ME, 0x55) !=
1439 USB_STOR_XFER_GOOD)
1440 return USB_STOR_TRANSPORT_ERROR;
1441
1442 if (usbat_write(us, USBAT_ATA, USBAT_ATA_LBA_HI, 0xAA) !=
1443 USB_STOR_XFER_GOOD)
1444 return USB_STOR_TRANSPORT_ERROR;
1445
1446 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
1447 USB_STOR_XFER_GOOD)
1448 return USB_STOR_TRANSPORT_ERROR;
1449
1450 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
1451 USB_STOR_XFER_GOOD)
1452 return USB_STOR_TRANSPORT_ERROR;
1453 }
1454
1455 return USB_STOR_TRANSPORT_GOOD;
1456}
1457
1458
1459
1460
1461static int init_usbat(struct us_data *us, int devicetype)
1462{
1463 int rc;
1464 struct usbat_info *info;
1465 unsigned char subcountH = USBAT_ATA_LBA_HI;
1466 unsigned char subcountL = USBAT_ATA_LBA_ME;
1467 unsigned char *status = us->iobuf;
1468
1469 us->extra = kzalloc(sizeof(struct usbat_info), GFP_NOIO);
1470 if (!us->extra)
1471 return 1;
1472
1473 info = (struct usbat_info *) (us->extra);
1474
1475
1476 rc = usbat_write_user_io(us,
1477 USBAT_UIO_OE1 | USBAT_UIO_OE0,
1478 USBAT_UIO_EPAD | USBAT_UIO_1);
1479 if (rc != USB_STOR_XFER_GOOD)
1480 return USB_STOR_TRANSPORT_ERROR;
1481
1482 usb_stor_dbg(us, "INIT 1\n");
1483
1484 msleep(2000);
1485
1486 rc = usbat_read_user_io(us, status);
1487 if (rc != USB_STOR_TRANSPORT_GOOD)
1488 return rc;
1489
1490 usb_stor_dbg(us, "INIT 2\n");
1491
1492 rc = usbat_read_user_io(us, status);
1493 if (rc != USB_STOR_XFER_GOOD)
1494 return USB_STOR_TRANSPORT_ERROR;
1495
1496 rc = usbat_read_user_io(us, status);
1497 if (rc != USB_STOR_XFER_GOOD)
1498 return USB_STOR_TRANSPORT_ERROR;
1499
1500 usb_stor_dbg(us, "INIT 3\n");
1501
1502 rc = usbat_select_and_test_registers(us);
1503 if (rc != USB_STOR_TRANSPORT_GOOD)
1504 return rc;
1505
1506 usb_stor_dbg(us, "INIT 4\n");
1507
1508 rc = usbat_read_user_io(us, status);
1509 if (rc != USB_STOR_XFER_GOOD)
1510 return USB_STOR_TRANSPORT_ERROR;
1511
1512 usb_stor_dbg(us, "INIT 5\n");
1513
1514
1515 rc = usbat_device_enable_cdt(us);
1516 if (rc != USB_STOR_TRANSPORT_GOOD)
1517 return rc;
1518
1519 usb_stor_dbg(us, "INIT 6\n");
1520
1521 rc = usbat_read_user_io(us, status);
1522 if (rc != USB_STOR_XFER_GOOD)
1523 return USB_STOR_TRANSPORT_ERROR;
1524
1525 usb_stor_dbg(us, "INIT 7\n");
1526
1527 msleep(1400);
1528
1529 rc = usbat_read_user_io(us, status);
1530 if (rc != USB_STOR_XFER_GOOD)
1531 return USB_STOR_TRANSPORT_ERROR;
1532
1533 usb_stor_dbg(us, "INIT 8\n");
1534
1535 rc = usbat_select_and_test_registers(us);
1536 if (rc != USB_STOR_TRANSPORT_GOOD)
1537 return rc;
1538
1539 usb_stor_dbg(us, "INIT 9\n");
1540
1541
1542 if (usbat_set_transport(us, info, devicetype))
1543 return USB_STOR_TRANSPORT_ERROR;
1544
1545 usb_stor_dbg(us, "INIT 10\n");
1546
1547 if (usbat_get_device_type(us) == USBAT_DEV_FLASH) {
1548 subcountH = 0x02;
1549 subcountL = 0x00;
1550 }
1551 rc = usbat_set_shuttle_features(us, (USBAT_FEAT_ETEN | USBAT_FEAT_ET2 | USBAT_FEAT_ET1),
1552 0x00, 0x88, 0x08, subcountH, subcountL);
1553 if (rc != USB_STOR_XFER_GOOD)
1554 return USB_STOR_TRANSPORT_ERROR;
1555
1556 usb_stor_dbg(us, "INIT 11\n");
1557
1558 return USB_STOR_TRANSPORT_GOOD;
1559}
1560
1561
1562
1563
1564static int usbat_hp8200e_transport(struct scsi_cmnd *srb, struct us_data *us)
1565{
1566 int result;
1567 unsigned char *status = us->iobuf;
1568 unsigned char registers[32];
1569 unsigned char data[32];
1570 unsigned int len;
1571 int i;
1572
1573 len = scsi_bufflen(srb);
1574
1575
1576
1577
1578
1579
1580
1581 registers[0] = USBAT_ATA_FEATURES;
1582 registers[1] = USBAT_ATA_SECCNT;
1583 registers[2] = USBAT_ATA_SECNUM;
1584 registers[3] = USBAT_ATA_LBA_ME;
1585 registers[4] = USBAT_ATA_LBA_HI;
1586 registers[5] = USBAT_ATA_DEVICE;
1587 registers[6] = USBAT_ATA_CMD;
1588 data[0] = 0x00;
1589 data[1] = 0x00;
1590 data[2] = 0x00;
1591 data[3] = len&0xFF;
1592 data[4] = (len>>8)&0xFF;
1593 data[5] = 0xB0;
1594 data[6] = 0xA0;
1595
1596 for (i=7; i<19; i++) {
1597 registers[i] = 0x10;
1598 data[i] = (i-7 >= srb->cmd_len) ? 0 : srb->cmnd[i-7];
1599 }
1600
1601 result = usbat_get_status(us, status);
1602 usb_stor_dbg(us, "Status = %02X\n", *status);
1603 if (result != USB_STOR_XFER_GOOD)
1604 return USB_STOR_TRANSPORT_ERROR;
1605 if (srb->cmnd[0] == TEST_UNIT_READY)
1606 transferred = 0;
1607
1608 if (srb->sc_data_direction == DMA_TO_DEVICE) {
1609
1610 result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
1611 registers, data, 19,
1612 USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
1613 (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
1614 DMA_TO_DEVICE,
1615 scsi_sglist(srb),
1616 len, scsi_sg_count(srb), 10);
1617
1618 if (result == USB_STOR_TRANSPORT_GOOD) {
1619 transferred += len;
1620 usb_stor_dbg(us, "Wrote %08X bytes\n", transferred);
1621 }
1622
1623 return result;
1624
1625 } else if (srb->cmnd[0] == READ_10 ||
1626 srb->cmnd[0] == GPCMD_READ_CD) {
1627
1628 return usbat_hp8200e_handle_read10(us, registers, data, srb);
1629
1630 }
1631
1632 if (len > 0xFFFF) {
1633 usb_stor_dbg(us, "Error: len = %08X... what do I do now?\n",
1634 len);
1635 return USB_STOR_TRANSPORT_ERROR;
1636 }
1637
1638 result = usbat_multiple_write(us, registers, data, 7);
1639
1640 if (result != USB_STOR_TRANSPORT_GOOD)
1641 return result;
1642
1643
1644
1645
1646
1647
1648
1649
1650
1651
1652
1653 result = usbat_write_block(us, USBAT_ATA, srb->cmnd, 12,
1654 srb->cmnd[0] == GPCMD_BLANK ? 75 : 10, 0);
1655
1656 if (result != USB_STOR_TRANSPORT_GOOD)
1657 return result;
1658
1659
1660
1661 if (len != 0 && (srb->sc_data_direction == DMA_FROM_DEVICE)) {
1662
1663
1664
1665 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
1666 USB_STOR_XFER_GOOD) {
1667 return USB_STOR_TRANSPORT_ERROR;
1668 }
1669
1670 if (len > 0xFF) {
1671 len = *status;
1672 if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_HI, status) !=
1673 USB_STOR_XFER_GOOD) {
1674 return USB_STOR_TRANSPORT_ERROR;
1675 }
1676 len += ((unsigned int) *status)<<8;
1677 }
1678 else
1679 len = *status;
1680
1681
1682 result = usbat_read_block(us, scsi_sglist(srb), len,
1683 scsi_sg_count(srb));
1684 }
1685
1686 return result;
1687}
1688
1689
1690
1691
1692static int usbat_flash_transport(struct scsi_cmnd * srb, struct us_data *us)
1693{
1694 int rc;
1695 struct usbat_info *info = (struct usbat_info *) (us->extra);
1696 unsigned long block, blocks;
1697 unsigned char *ptr = us->iobuf;
1698 static unsigned char inquiry_response[36] = {
1699 0x00, 0x80, 0x00, 0x01, 0x1F, 0x00, 0x00, 0x00
1700 };
1701
1702 if (srb->cmnd[0] == INQUIRY) {
1703 usb_stor_dbg(us, "INQUIRY - Returning bogus response\n");
1704 memcpy(ptr, inquiry_response, sizeof(inquiry_response));
1705 fill_inquiry_response(us, ptr, 36);
1706 return USB_STOR_TRANSPORT_GOOD;
1707 }
1708
1709 if (srb->cmnd[0] == READ_CAPACITY) {
1710 rc = usbat_flash_check_media(us, info);
1711 if (rc != USB_STOR_TRANSPORT_GOOD)
1712 return rc;
1713
1714 rc = usbat_flash_get_sector_count(us, info);
1715 if (rc != USB_STOR_TRANSPORT_GOOD)
1716 return rc;
1717
1718
1719 info->ssize = 0x200;
1720 usb_stor_dbg(us, "READ_CAPACITY: %ld sectors, %ld bytes per sector\n",
1721 info->sectors, info->ssize);
1722
1723
1724
1725
1726
1727
1728 ((__be32 *) ptr)[0] = cpu_to_be32(info->sectors - 1);
1729 ((__be32 *) ptr)[1] = cpu_to_be32(info->ssize);
1730 usb_stor_set_xfer_buf(ptr, 8, srb);
1731
1732 return USB_STOR_TRANSPORT_GOOD;
1733 }
1734
1735 if (srb->cmnd[0] == MODE_SELECT_10) {
1736 usb_stor_dbg(us, "Gah! MODE_SELECT_10\n");
1737 return USB_STOR_TRANSPORT_ERROR;
1738 }
1739
1740 if (srb->cmnd[0] == READ_10) {
1741 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
1742 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
1743
1744 blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
1745
1746 usb_stor_dbg(us, "READ_10: read block 0x%04lx count %ld\n",
1747 block, blocks);
1748 return usbat_flash_read_data(us, info, block, blocks);
1749 }
1750
1751 if (srb->cmnd[0] == READ_12) {
1752
1753
1754
1755 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
1756 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
1757
1758 blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
1759 ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
1760
1761 usb_stor_dbg(us, "READ_12: read block 0x%04lx count %ld\n",
1762 block, blocks);
1763 return usbat_flash_read_data(us, info, block, blocks);
1764 }
1765
1766 if (srb->cmnd[0] == WRITE_10) {
1767 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
1768 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
1769
1770 blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
1771
1772 usb_stor_dbg(us, "WRITE_10: write block 0x%04lx count %ld\n",
1773 block, blocks);
1774 return usbat_flash_write_data(us, info, block, blocks);
1775 }
1776
1777 if (srb->cmnd[0] == WRITE_12) {
1778
1779
1780
1781 block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
1782 ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
1783
1784 blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
1785 ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
1786
1787 usb_stor_dbg(us, "WRITE_12: write block 0x%04lx count %ld\n",
1788 block, blocks);
1789 return usbat_flash_write_data(us, info, block, blocks);
1790 }
1791
1792
1793 if (srb->cmnd[0] == TEST_UNIT_READY) {
1794 usb_stor_dbg(us, "TEST_UNIT_READY\n");
1795
1796 rc = usbat_flash_check_media(us, info);
1797 if (rc != USB_STOR_TRANSPORT_GOOD)
1798 return rc;
1799
1800 return usbat_check_status(us);
1801 }
1802
1803 if (srb->cmnd[0] == REQUEST_SENSE) {
1804 usb_stor_dbg(us, "REQUEST_SENSE\n");
1805
1806 memset(ptr, 0, 18);
1807 ptr[0] = 0xF0;
1808 ptr[2] = info->sense_key;
1809 ptr[7] = 11;
1810 ptr[12] = info->sense_asc;
1811 ptr[13] = info->sense_ascq;
1812 usb_stor_set_xfer_buf(ptr, 18, srb);
1813
1814 return USB_STOR_TRANSPORT_GOOD;
1815 }
1816
1817 if (srb->cmnd[0] == ALLOW_MEDIUM_REMOVAL) {
1818
1819
1820
1821
1822 return USB_STOR_TRANSPORT_GOOD;
1823 }
1824
1825 usb_stor_dbg(us, "Gah! Unknown command: %d (0x%x)\n",
1826 srb->cmnd[0], srb->cmnd[0]);
1827 info->sense_key = 0x05;
1828 info->sense_asc = 0x20;
1829 info->sense_ascq = 0x00;
1830 return USB_STOR_TRANSPORT_FAILED;
1831}
1832
1833static int init_usbat_cd(struct us_data *us)
1834{
1835 return init_usbat(us, USBAT_DEV_HP8200);
1836}
1837
1838static int init_usbat_flash(struct us_data *us)
1839{
1840 return init_usbat(us, USBAT_DEV_FLASH);
1841}
1842
1843static struct scsi_host_template usbat_host_template;
1844
1845static int usbat_probe(struct usb_interface *intf,
1846 const struct usb_device_id *id)
1847{
1848 struct us_data *us;
1849 int result;
1850
1851 result = usb_stor_probe1(&us, intf, id,
1852 (id - usbat_usb_ids) + usbat_unusual_dev_list,
1853 &usbat_host_template);
1854 if (result)
1855 return result;
1856
1857
1858
1859
1860
1861 us->transport_name = "Shuttle USBAT";
1862 us->transport = usbat_flash_transport;
1863 us->transport_reset = usb_stor_CB_reset;
1864 us->max_lun = 0;
1865
1866 result = usb_stor_probe2(us);
1867 return result;
1868}
1869
1870static struct usb_driver usbat_driver = {
1871 .name = DRV_NAME,
1872 .probe = usbat_probe,
1873 .disconnect = usb_stor_disconnect,
1874 .suspend = usb_stor_suspend,
1875 .resume = usb_stor_resume,
1876 .reset_resume = usb_stor_reset_resume,
1877 .pre_reset = usb_stor_pre_reset,
1878 .post_reset = usb_stor_post_reset,
1879 .id_table = usbat_usb_ids,
1880 .soft_unbind = 1,
1881 .no_dynamic_id = 1,
1882};
1883
1884module_usb_stor_driver(usbat_driver, usbat_host_template, DRV_NAME);
1885