Merge branches 'release' and 'menlo' into release
[linux-2.6] / drivers / usb / storage / isd200.c
1 /* Transport & Protocol Driver for In-System Design, Inc. ISD200 ASIC
2  *
3  * $Id: isd200.c,v 1.16 2002/04/22 03:39:43 mdharm Exp $
4  *
5  * Current development and maintenance:
6  *   (C) 2001-2002 Björn Stenberg (bjorn@haxx.se)
7  *
8  * Developed with the assistance of:
9  *   (C) 2002 Alan Stern <stern@rowland.org>
10  *
11  * Initial work:
12  *   (C) 2000 In-System Design, Inc. (support@in-system.com)
13  *
14  * The ISD200 ASIC does not natively support ATA devices.  The chip
15  * does implement an interface, the ATA Command Block (ATACB) which provides
16  * a means of passing ATA commands and ATA register accesses to a device.
17  *
18  * This program is free software; you can redistribute it and/or modify it
19  * under the terms of the GNU General Public License as published by the
20  * Free Software Foundation; either version 2, or (at your option) any
21  * later version.
22  *
23  * This program is distributed in the hope that it will be useful, but
24  * WITHOUT ANY WARRANTY; without even the implied warranty of
25  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
26  * General Public License for more details.
27  *
28  * You should have received a copy of the GNU General Public License along
29  * with this program; if not, write to the Free Software Foundation, Inc.,
30  * 675 Mass Ave, Cambridge, MA 02139, USA.
31  *
32  * History:
33  *
34  *  2002-10-19: Removed the specialized transfer routines.
35  *              (Alan Stern <stern@rowland.harvard.edu>)
36  *  2001-02-24: Removed lots of duplicate code and simplified the structure.
37  *            (bjorn@haxx.se)
38  *  2002-01-16: Fixed endianness bug so it works on the ppc arch.
39  *            (Luc Saillard <luc@saillard.org>)
40  *  2002-01-17: All bitfields removed.
41  *            (bjorn@haxx.se)
42  */
43
44
45 /* Include files */
46
47 #include <linux/jiffies.h>
48 #include <linux/errno.h>
49 #include <linux/slab.h>
50 #include <linux/hdreg.h>
51 #include <linux/scatterlist.h>
52
53 #include <scsi/scsi.h>
54 #include <scsi/scsi_cmnd.h>
55 #include <scsi/scsi_device.h>
56
57 #include "usb.h"
58 #include "transport.h"
59 #include "protocol.h"
60 #include "debug.h"
61 #include "scsiglue.h"
62 #include "isd200.h"
63
64
65 /* Timeout defines (in Seconds) */
66
67 #define ISD200_ENUM_BSY_TIMEOUT         35
68 #define ISD200_ENUM_DETECT_TIMEOUT      30
69 #define ISD200_DEFAULT_TIMEOUT          30
70
71 /* device flags */
72 #define DF_ATA_DEVICE           0x0001
73 #define DF_MEDIA_STATUS_ENABLED 0x0002
74 #define DF_REMOVABLE_MEDIA      0x0004
75
76 /* capability bit definitions */
77 #define CAPABILITY_DMA          0x01
78 #define CAPABILITY_LBA          0x02
79
80 /* command_setX bit definitions */
81 #define COMMANDSET_REMOVABLE    0x02
82 #define COMMANDSET_MEDIA_STATUS 0x10
83
84 /* ATA Vendor Specific defines */
85 #define ATA_ADDRESS_DEVHEAD_STD      0xa0
86 #define ATA_ADDRESS_DEVHEAD_LBA_MODE 0x40    
87 #define ATA_ADDRESS_DEVHEAD_SLAVE    0x10
88
89 /* Action Select bits */
90 #define ACTION_SELECT_0      0x01
91 #define ACTION_SELECT_1      0x02
92 #define ACTION_SELECT_2      0x04
93 #define ACTION_SELECT_3      0x08
94 #define ACTION_SELECT_4      0x10
95 #define ACTION_SELECT_5      0x20
96 #define ACTION_SELECT_6      0x40
97 #define ACTION_SELECT_7      0x80
98
99 /* Register Select bits */
100 #define REG_ALTERNATE_STATUS    0x01
101 #define REG_DEVICE_CONTROL      0x01
102 #define REG_ERROR               0x02
103 #define REG_FEATURES            0x02
104 #define REG_SECTOR_COUNT        0x04
105 #define REG_SECTOR_NUMBER       0x08
106 #define REG_CYLINDER_LOW        0x10
107 #define REG_CYLINDER_HIGH       0x20
108 #define REG_DEVICE_HEAD         0x40
109 #define REG_STATUS              0x80
110 #define REG_COMMAND             0x80
111
112 /* ATA registers offset definitions */
113 #define ATA_REG_ERROR_OFFSET            1
114 #define ATA_REG_LCYL_OFFSET             4
115 #define ATA_REG_HCYL_OFFSET             5
116 #define ATA_REG_STATUS_OFFSET           7
117
118 /* ATA error definitions not in <linux/hdreg.h> */
119 #define ATA_ERROR_MEDIA_CHANGE          0x20
120
121 /* ATA command definitions not in <linux/hdreg.h> */
122 #define ATA_COMMAND_GET_MEDIA_STATUS    0xDA
123 #define ATA_COMMAND_MEDIA_EJECT         0xED
124
125 /* ATA drive control definitions */
126 #define ATA_DC_DISABLE_INTERRUPTS       0x02
127 #define ATA_DC_RESET_CONTROLLER         0x04
128 #define ATA_DC_REENABLE_CONTROLLER      0x00
129
130 /*
131  *  General purpose return codes
132  */ 
133
134 #define ISD200_ERROR            -1
135 #define ISD200_GOOD              0
136
137 /*
138  * Transport return codes
139  */
140
141 #define ISD200_TRANSPORT_GOOD       0   /* Transport good, command good     */
142 #define ISD200_TRANSPORT_FAILED     1   /* Transport good, command failed   */
143 #define ISD200_TRANSPORT_ERROR      2   /* Transport bad (i.e. device dead) */
144
145 /* driver action codes */
146 #define ACTION_READ_STATUS      0
147 #define ACTION_RESET            1
148 #define ACTION_REENABLE         2
149 #define ACTION_SOFT_RESET       3
150 #define ACTION_ENUM             4
151 #define ACTION_IDENTIFY         5
152
153
154 /*
155  * ata_cdb struct
156  */
157
158
159 union ata_cdb {
160         struct {
161                 unsigned char SignatureByte0;
162                 unsigned char SignatureByte1;
163                 unsigned char ActionSelect;
164                 unsigned char RegisterSelect;
165                 unsigned char TransferBlockSize;
166                 unsigned char WriteData3F6;
167                 unsigned char WriteData1F1;
168                 unsigned char WriteData1F2;
169                 unsigned char WriteData1F3;
170                 unsigned char WriteData1F4;
171                 unsigned char WriteData1F5;
172                 unsigned char WriteData1F6;
173                 unsigned char WriteData1F7;
174                 unsigned char Reserved[3];
175         } generic;
176
177         struct {
178                 unsigned char SignatureByte0;
179                 unsigned char SignatureByte1;
180                 unsigned char ActionSelect;
181                 unsigned char RegisterSelect;
182                 unsigned char TransferBlockSize;
183                 unsigned char AlternateStatusByte;
184                 unsigned char ErrorByte;
185                 unsigned char SectorCountByte;
186                 unsigned char SectorNumberByte;
187                 unsigned char CylinderLowByte;
188                 unsigned char CylinderHighByte;
189                 unsigned char DeviceHeadByte;
190                 unsigned char StatusByte;
191                 unsigned char Reserved[3];
192         } read;
193
194         struct {
195                 unsigned char SignatureByte0;
196                 unsigned char SignatureByte1;
197                 unsigned char ActionSelect;
198                 unsigned char RegisterSelect;
199                 unsigned char TransferBlockSize;
200                 unsigned char DeviceControlByte;
201                 unsigned char FeaturesByte;
202                 unsigned char SectorCountByte;
203                 unsigned char SectorNumberByte;
204                 unsigned char CylinderLowByte;
205                 unsigned char CylinderHighByte;
206                 unsigned char DeviceHeadByte;
207                 unsigned char CommandByte;
208                 unsigned char Reserved[3];
209         } write;
210 };
211
212
213 /*
214  * Inquiry data structure. This is the data returned from the target
215  * after it receives an inquiry.
216  *
217  * This structure may be extended by the number of bytes specified
218  * in the field AdditionalLength. The defined size constant only
219  * includes fields through ProductRevisionLevel.
220  */
221
222 /*
223  * DeviceType field
224  */
225 #define DIRECT_ACCESS_DEVICE        0x00    /* disks */
226 #define DEVICE_REMOVABLE                0x80
227
228 struct inquiry_data {
229         unsigned char DeviceType;
230         unsigned char DeviceTypeModifier;
231         unsigned char Versions;
232         unsigned char Format; 
233         unsigned char AdditionalLength;
234         unsigned char Reserved[2];
235         unsigned char Capability;
236         unsigned char VendorId[8];
237         unsigned char ProductId[16];
238         unsigned char ProductRevisionLevel[4];
239         unsigned char VendorSpecific[20];
240         unsigned char Reserved3[40];
241 } __attribute__ ((packed));
242
243 /*
244  * INQUIRY data buffer size
245  */
246
247 #define INQUIRYDATABUFFERSIZE 36
248
249
250 /*
251  * ISD200 CONFIG data struct
252  */
253
254 #define ATACFG_TIMING     0x0f
255 #define ATACFG_ATAPI_RESET     0x10
256 #define ATACFG_MASTER     0x20
257 #define ATACFG_BLOCKSIZE       0xa0
258
259 #define ATACFGE_LAST_LUN       0x07
260 #define ATACFGE_DESC_OVERRIDE  0x08
261 #define ATACFGE_STATE_SUSPEND  0x10
262 #define ATACFGE_SKIP_BOOT      0x20
263 #define ATACFGE_CONF_DESC2     0x40
264 #define ATACFGE_INIT_STATUS    0x80
265
266 #define CFG_CAPABILITY_SRST    0x01
267
268 struct isd200_config {
269         unsigned char EventNotification;
270         unsigned char ExternalClock;
271         unsigned char ATAInitTimeout;
272         unsigned char ATAConfig;
273         unsigned char ATAMajorCommand;
274         unsigned char ATAMinorCommand;
275         unsigned char ATAExtraConfig;
276         unsigned char Capability;
277 }__attribute__ ((packed));
278
279
280 /*
281  * ISD200 driver information struct
282  */
283
284 struct isd200_info {
285         struct inquiry_data InquiryData;
286         struct hd_driveid *id;
287         struct isd200_config ConfigData;
288         unsigned char *RegsBuf;
289         unsigned char ATARegs[8];
290         unsigned char DeviceHead;
291         unsigned char DeviceFlags;
292
293         /* maximum number of LUNs supported */
294         unsigned char MaxLUNs;
295         struct scsi_cmnd srb;
296         struct scatterlist sg;
297 };
298
299
300 /*
301  * Read Capacity Data - returned in Big Endian format
302  */
303
304 struct read_capacity_data {
305         __be32 LogicalBlockAddress;
306         __be32 BytesPerBlock;
307 };
308
309 /*
310  * Read Block Limits Data - returned in Big Endian format
311  * This structure returns the maximum and minimum block
312  * size for a TAPE device.
313  */
314
315 struct read_block_limits {
316         unsigned char Reserved;
317         unsigned char BlockMaximumSize[3];
318         unsigned char BlockMinimumSize[2];
319 };
320
321
322 /*
323  * Sense Data Format
324  */
325
326 #define SENSE_ERRCODE      0x7f
327 #define SENSE_ERRCODE_VALID     0x80
328 #define SENSE_FLAG_SENSE_KEY    0x0f
329 #define SENSE_FLAG_BAD_LENGTH   0x20
330 #define SENSE_FLAG_END_OF_MEDIA 0x40
331 #define SENSE_FLAG_FILE_MARK    0x80
332 struct sense_data {
333         unsigned char ErrorCode;
334         unsigned char SegmentNumber;
335         unsigned char Flags;
336         unsigned char Information[4];
337         unsigned char AdditionalSenseLength;
338         unsigned char CommandSpecificInformation[4];
339         unsigned char AdditionalSenseCode;
340         unsigned char AdditionalSenseCodeQualifier;
341         unsigned char FieldReplaceableUnitCode;
342         unsigned char SenseKeySpecific[3];
343 } __attribute__ ((packed));
344
345 /*
346  * Default request sense buffer size
347  */
348
349 #define SENSE_BUFFER_SIZE 18
350
351 /***********************************************************************
352  * Helper routines
353  ***********************************************************************/
354
355 /**************************************************************************
356  * isd200_build_sense
357  *                                                                       
358  *  Builds an artificial sense buffer to report the results of a 
359  *  failed command.
360  *                                                                     
361  * RETURNS:
362  *    void
363  */
364 static void isd200_build_sense(struct us_data *us, struct scsi_cmnd *srb)
365 {
366         struct isd200_info *info = (struct isd200_info *)us->extra;
367         struct sense_data *buf = (struct sense_data *) &srb->sense_buffer[0];
368         unsigned char error = info->ATARegs[ATA_REG_ERROR_OFFSET];
369
370         if(error & ATA_ERROR_MEDIA_CHANGE) {
371                 buf->ErrorCode = 0x70 | SENSE_ERRCODE_VALID;
372                 buf->AdditionalSenseLength = 0xb;
373                 buf->Flags = UNIT_ATTENTION;
374                 buf->AdditionalSenseCode = 0;
375                 buf->AdditionalSenseCodeQualifier = 0;
376         } else if(error & MCR_ERR) {
377                 buf->ErrorCode = 0x70 | SENSE_ERRCODE_VALID;
378                 buf->AdditionalSenseLength = 0xb;
379                 buf->Flags =  UNIT_ATTENTION;
380                 buf->AdditionalSenseCode = 0;
381                 buf->AdditionalSenseCodeQualifier = 0;
382         } else if(error & TRK0_ERR) {
383                 buf->ErrorCode = 0x70 | SENSE_ERRCODE_VALID;
384                 buf->AdditionalSenseLength = 0xb;
385                 buf->Flags =  NOT_READY;
386                 buf->AdditionalSenseCode = 0;
387                 buf->AdditionalSenseCodeQualifier = 0;
388         } else if(error & ECC_ERR) {
389                 buf->ErrorCode = 0x70 | SENSE_ERRCODE_VALID;
390                 buf->AdditionalSenseLength = 0xb;
391                 buf->Flags =  DATA_PROTECT;
392                 buf->AdditionalSenseCode = 0;
393                 buf->AdditionalSenseCodeQualifier = 0;
394         } else {
395                 buf->ErrorCode = 0;
396                 buf->AdditionalSenseLength = 0;
397                 buf->Flags =  0;
398                 buf->AdditionalSenseCode = 0;
399                 buf->AdditionalSenseCodeQualifier = 0;
400         }
401 }
402
403
404 /***********************************************************************
405  * Transport routines
406  ***********************************************************************/
407
408 /**************************************************************************
409  *  isd200_set_srb(), isd200_srb_set_bufflen()
410  *
411  * Two helpers to facilitate in initialization of scsi_cmnd structure
412  * Will need to change when struct scsi_cmnd changes
413  */
414 static void isd200_set_srb(struct isd200_info *info,
415         enum dma_data_direction dir, void* buff, unsigned bufflen)
416 {
417         struct scsi_cmnd *srb = &info->srb;
418
419         if (buff)
420                 sg_init_one(&info->sg, buff, bufflen);
421
422         srb->sc_data_direction = dir;
423         srb->sdb.table.sgl = buff ? &info->sg : NULL;
424         srb->sdb.length = bufflen;
425         srb->sdb.table.nents = buff ? 1 : 0;
426 }
427
428 static void isd200_srb_set_bufflen(struct scsi_cmnd *srb, unsigned bufflen)
429 {
430         srb->sdb.length = bufflen;
431 }
432
433
434 /**************************************************************************
435  *  isd200_action
436  *
437  * Routine for sending commands to the isd200
438  *
439  * RETURNS:
440  *    ISD status code
441  */
442 static int isd200_action( struct us_data *us, int action, 
443                           void* pointer, int value )
444 {
445         union ata_cdb ata;
446         struct scsi_device srb_dev;
447         struct isd200_info *info = (struct isd200_info *)us->extra;
448         struct scsi_cmnd *srb = &info->srb;
449         int status;
450
451         memset(&ata, 0, sizeof(ata));
452         memset(&srb_dev, 0, sizeof(srb_dev));
453         srb->device = &srb_dev;
454         ++srb->serial_number;
455
456         ata.generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
457         ata.generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
458         ata.generic.TransferBlockSize = 1;
459
460         switch ( action ) {
461         case ACTION_READ_STATUS:
462                 US_DEBUGP("   isd200_action(READ_STATUS)\n");
463                 ata.generic.ActionSelect = ACTION_SELECT_0|ACTION_SELECT_2;
464                 ata.generic.RegisterSelect =
465                   REG_CYLINDER_LOW | REG_CYLINDER_HIGH |
466                   REG_STATUS | REG_ERROR;
467                 isd200_set_srb(info, DMA_FROM_DEVICE, pointer, value);
468                 break;
469
470         case ACTION_ENUM:
471                 US_DEBUGP("   isd200_action(ENUM,0x%02x)\n",value);
472                 ata.generic.ActionSelect = ACTION_SELECT_1|ACTION_SELECT_2|
473                                            ACTION_SELECT_3|ACTION_SELECT_4|
474                                            ACTION_SELECT_5;
475                 ata.generic.RegisterSelect = REG_DEVICE_HEAD;
476                 ata.write.DeviceHeadByte = value;
477                 isd200_set_srb(info, DMA_NONE, NULL, 0);
478                 break;
479
480         case ACTION_RESET:
481                 US_DEBUGP("   isd200_action(RESET)\n");
482                 ata.generic.ActionSelect = ACTION_SELECT_1|ACTION_SELECT_2|
483                                            ACTION_SELECT_3|ACTION_SELECT_4;
484                 ata.generic.RegisterSelect = REG_DEVICE_CONTROL;
485                 ata.write.DeviceControlByte = ATA_DC_RESET_CONTROLLER;
486                 isd200_set_srb(info, DMA_NONE, NULL, 0);
487                 break;
488
489         case ACTION_REENABLE:
490                 US_DEBUGP("   isd200_action(REENABLE)\n");
491                 ata.generic.ActionSelect = ACTION_SELECT_1|ACTION_SELECT_2|
492                                            ACTION_SELECT_3|ACTION_SELECT_4;
493                 ata.generic.RegisterSelect = REG_DEVICE_CONTROL;
494                 ata.write.DeviceControlByte = ATA_DC_REENABLE_CONTROLLER;
495                 isd200_set_srb(info, DMA_NONE, NULL, 0);
496                 break;
497
498         case ACTION_SOFT_RESET:
499                 US_DEBUGP("   isd200_action(SOFT_RESET)\n");
500                 ata.generic.ActionSelect = ACTION_SELECT_1|ACTION_SELECT_5;
501                 ata.generic.RegisterSelect = REG_DEVICE_HEAD | REG_COMMAND;
502                 ata.write.DeviceHeadByte = info->DeviceHead;
503                 ata.write.CommandByte = WIN_SRST;
504                 isd200_set_srb(info, DMA_NONE, NULL, 0);
505                 break;
506
507         case ACTION_IDENTIFY:
508                 US_DEBUGP("   isd200_action(IDENTIFY)\n");
509                 ata.generic.RegisterSelect = REG_COMMAND;
510                 ata.write.CommandByte = WIN_IDENTIFY;
511                 isd200_set_srb(info, DMA_FROM_DEVICE, info->id,
512                                                 sizeof(struct hd_driveid));
513                 break;
514
515         default:
516                 US_DEBUGP("Error: Undefined action %d\n",action);
517                 return ISD200_ERROR;
518         }
519
520         memcpy(srb->cmnd, &ata, sizeof(ata.generic));
521         srb->cmd_len = sizeof(ata.generic);
522         status = usb_stor_Bulk_transport(srb, us);
523         if (status == USB_STOR_TRANSPORT_GOOD)
524                 status = ISD200_GOOD;
525         else {
526                 US_DEBUGP("   isd200_action(0x%02x) error: %d\n",action,status);
527                 status = ISD200_ERROR;
528                 /* need to reset device here */
529         }
530
531         return status;
532 }
533
534 /**************************************************************************
535  * isd200_read_regs
536  *                                                                       
537  * Read ATA Registers
538  *
539  * RETURNS:
540  *    ISD status code
541  */
542 static int isd200_read_regs( struct us_data *us )
543 {
544         struct isd200_info *info = (struct isd200_info *)us->extra;
545         int retStatus = ISD200_GOOD;
546         int transferStatus;
547
548         US_DEBUGP("Entering isd200_IssueATAReadRegs\n");
549
550         transferStatus = isd200_action( us, ACTION_READ_STATUS,
551                                     info->RegsBuf, sizeof(info->ATARegs) );
552         if (transferStatus != ISD200_TRANSPORT_GOOD) {
553                 US_DEBUGP("   Error reading ATA registers\n");
554                 retStatus = ISD200_ERROR;
555         } else {
556                 memcpy(info->ATARegs, info->RegsBuf, sizeof(info->ATARegs));
557                 US_DEBUGP("   Got ATA Register[ATA_REG_ERROR_OFFSET] = 0x%x\n",
558                           info->ATARegs[ATA_REG_ERROR_OFFSET]);
559         }
560
561         return retStatus;
562 }
563
564
565 /**************************************************************************
566  * Invoke the transport and basic error-handling/recovery methods
567  *
568  * This is used by the protocol layers to actually send the message to
569  * the device and receive the response.
570  */
571 static void isd200_invoke_transport( struct us_data *us, 
572                               struct scsi_cmnd *srb, 
573                               union ata_cdb *ataCdb )
574 {
575         int need_auto_sense = 0;
576         int transferStatus;
577         int result;
578
579         /* send the command to the transport layer */
580         memcpy(srb->cmnd, ataCdb, sizeof(ataCdb->generic));
581         srb->cmd_len = sizeof(ataCdb->generic);
582         transferStatus = usb_stor_Bulk_transport(srb, us);
583
584         /* if the command gets aborted by the higher layers, we need to
585          * short-circuit all other processing
586          */
587         if (test_bit(US_FLIDX_TIMED_OUT, &us->flags)) {
588                 US_DEBUGP("-- command was aborted\n");
589                 goto Handle_Abort;
590         }
591
592         switch (transferStatus) {
593
594         case USB_STOR_TRANSPORT_GOOD:
595                 /* Indicate a good result */
596                 srb->result = SAM_STAT_GOOD;
597                 break;
598
599         case USB_STOR_TRANSPORT_NO_SENSE:
600                 US_DEBUGP("-- transport indicates protocol failure\n");
601                 srb->result = SAM_STAT_CHECK_CONDITION;
602                 return;
603
604         case USB_STOR_TRANSPORT_FAILED:
605                 US_DEBUGP("-- transport indicates command failure\n");
606                 need_auto_sense = 1;
607                 break;
608
609         case USB_STOR_TRANSPORT_ERROR:
610                 US_DEBUGP("-- transport indicates transport error\n");
611                 srb->result = DID_ERROR << 16;
612                 /* Need reset here */
613                 return;
614     
615         default:
616                 US_DEBUGP("-- transport indicates unknown error\n");   
617                 srb->result = DID_ERROR << 16;
618                 /* Need reset here */
619                 return;
620         }
621
622         if ((scsi_get_resid(srb) > 0) &&
623             !((srb->cmnd[0] == REQUEST_SENSE) ||
624               (srb->cmnd[0] == INQUIRY) ||
625               (srb->cmnd[0] == MODE_SENSE) ||
626               (srb->cmnd[0] == LOG_SENSE) ||
627               (srb->cmnd[0] == MODE_SENSE_10))) {
628                 US_DEBUGP("-- unexpectedly short transfer\n");
629                 need_auto_sense = 1;
630         }
631
632         if (need_auto_sense) {
633                 result = isd200_read_regs(us);
634                 if (test_bit(US_FLIDX_TIMED_OUT, &us->flags)) {
635                         US_DEBUGP("-- auto-sense aborted\n");
636                         goto Handle_Abort;
637                 }
638                 if (result == ISD200_GOOD) {
639                         isd200_build_sense(us, srb);
640                         srb->result = SAM_STAT_CHECK_CONDITION;
641
642                         /* If things are really okay, then let's show that */
643                         if ((srb->sense_buffer[2] & 0xf) == 0x0)
644                                 srb->result = SAM_STAT_GOOD;
645                 } else {
646                         srb->result = DID_ERROR << 16;
647                         /* Need reset here */
648                 }
649         }
650
651         /* Regardless of auto-sense, if we _know_ we have an error
652          * condition, show that in the result code
653          */
654         if (transferStatus == USB_STOR_TRANSPORT_FAILED)
655                 srb->result = SAM_STAT_CHECK_CONDITION;
656         return;
657
658         /* abort processing: the bulk-only transport requires a reset
659          * following an abort */
660         Handle_Abort:
661         srb->result = DID_ABORT << 16;
662
663         /* permit the reset transfer to take place */
664         clear_bit(US_FLIDX_ABORTING, &us->flags);
665         /* Need reset here */
666 }
667
668 #ifdef CONFIG_USB_STORAGE_DEBUG
669 static void isd200_log_config( struct isd200_info* info )
670 {
671         US_DEBUGP("      Event Notification: 0x%x\n", 
672                   info->ConfigData.EventNotification);
673         US_DEBUGP("      External Clock: 0x%x\n", 
674                   info->ConfigData.ExternalClock);
675         US_DEBUGP("      ATA Init Timeout: 0x%x\n", 
676                   info->ConfigData.ATAInitTimeout);
677         US_DEBUGP("      ATAPI Command Block Size: 0x%x\n", 
678                   (info->ConfigData.ATAConfig & ATACFG_BLOCKSIZE) >> 6);
679         US_DEBUGP("      Master/Slave Selection: 0x%x\n", 
680                   info->ConfigData.ATAConfig & ATACFG_MASTER);
681         US_DEBUGP("      ATAPI Reset: 0x%x\n",
682                   info->ConfigData.ATAConfig & ATACFG_ATAPI_RESET);
683         US_DEBUGP("      ATA Timing: 0x%x\n",
684                   info->ConfigData.ATAConfig & ATACFG_TIMING);
685         US_DEBUGP("      ATA Major Command: 0x%x\n", 
686                   info->ConfigData.ATAMajorCommand);
687         US_DEBUGP("      ATA Minor Command: 0x%x\n", 
688                   info->ConfigData.ATAMinorCommand);
689         US_DEBUGP("      Init Status: 0x%x\n", 
690                   info->ConfigData.ATAExtraConfig & ATACFGE_INIT_STATUS);
691         US_DEBUGP("      Config Descriptor 2: 0x%x\n", 
692                   info->ConfigData.ATAExtraConfig & ATACFGE_CONF_DESC2);
693         US_DEBUGP("      Skip Device Boot: 0x%x\n",
694                   info->ConfigData.ATAExtraConfig & ATACFGE_SKIP_BOOT);
695         US_DEBUGP("      ATA 3 State Supsend: 0x%x\n",
696                   info->ConfigData.ATAExtraConfig & ATACFGE_STATE_SUSPEND);
697         US_DEBUGP("      Descriptor Override: 0x%x\n", 
698                   info->ConfigData.ATAExtraConfig & ATACFGE_DESC_OVERRIDE);
699         US_DEBUGP("      Last LUN Identifier: 0x%x\n",
700                   info->ConfigData.ATAExtraConfig & ATACFGE_LAST_LUN);
701         US_DEBUGP("      SRST Enable: 0x%x\n", 
702                   info->ConfigData.ATAExtraConfig & CFG_CAPABILITY_SRST);
703 }
704 #endif
705
706 /**************************************************************************
707  * isd200_write_config
708  *                                                                       
709  * Write the ISD200 Configuration data
710  *
711  * RETURNS:
712  *    ISD status code
713  */
714 static int isd200_write_config( struct us_data *us ) 
715 {
716         struct isd200_info *info = (struct isd200_info *)us->extra;
717         int retStatus = ISD200_GOOD;
718         int result;
719
720 #ifdef CONFIG_USB_STORAGE_DEBUG
721         US_DEBUGP("Entering isd200_write_config\n");
722         US_DEBUGP("   Writing the following ISD200 Config Data:\n");
723         isd200_log_config(info);
724 #endif
725
726         /* let's send the command via the control pipe */
727         result = usb_stor_ctrl_transfer(
728                 us, 
729                 us->send_ctrl_pipe,
730                 0x01, 
731                 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
732                 0x0000, 
733                 0x0002, 
734                 (void *) &info->ConfigData, 
735                 sizeof(info->ConfigData));
736
737         if (result >= 0) {
738                 US_DEBUGP("   ISD200 Config Data was written successfully\n");
739         } else {
740                 US_DEBUGP("   Request to write ISD200 Config Data failed!\n");
741                 retStatus = ISD200_ERROR;
742         }
743
744         US_DEBUGP("Leaving isd200_write_config %08X\n", retStatus);
745         return retStatus;
746 }
747
748
749 /**************************************************************************
750  * isd200_read_config
751  *                                                                       
752  * Reads the ISD200 Configuration data
753  *
754  * RETURNS:
755  *    ISD status code
756  */
757 static int isd200_read_config( struct us_data *us ) 
758 {
759         struct isd200_info *info = (struct isd200_info *)us->extra;
760         int retStatus = ISD200_GOOD;
761         int result;
762
763         US_DEBUGP("Entering isd200_read_config\n");
764
765         /* read the configuration information from ISD200.  Use this to */
766         /* determine what the special ATA CDB bytes are.                */
767
768         result = usb_stor_ctrl_transfer(
769                 us, 
770                 us->recv_ctrl_pipe,
771                 0x02, 
772                 USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
773                 0x0000, 
774                 0x0002, 
775                 (void *) &info->ConfigData, 
776                 sizeof(info->ConfigData));
777
778
779         if (result >= 0) {
780                 US_DEBUGP("   Retrieved the following ISD200 Config Data:\n");
781 #ifdef CONFIG_USB_STORAGE_DEBUG
782                 isd200_log_config(info);
783 #endif
784         } else {
785                 US_DEBUGP("   Request to get ISD200 Config Data failed!\n");
786                 retStatus = ISD200_ERROR;
787         }
788
789         US_DEBUGP("Leaving isd200_read_config %08X\n", retStatus);
790         return retStatus;
791 }
792
793
794 /**************************************************************************
795  * isd200_atapi_soft_reset
796  *                                                                       
797  * Perform an Atapi Soft Reset on the device
798  *
799  * RETURNS:
800  *    NT status code
801  */
802 static int isd200_atapi_soft_reset( struct us_data *us ) 
803 {
804         int retStatus = ISD200_GOOD;
805         int transferStatus;
806
807         US_DEBUGP("Entering isd200_atapi_soft_reset\n");
808
809         transferStatus = isd200_action( us, ACTION_SOFT_RESET, NULL, 0 );
810         if (transferStatus != ISD200_TRANSPORT_GOOD) {
811                 US_DEBUGP("   Error issuing Atapi Soft Reset\n");
812                 retStatus = ISD200_ERROR;
813         }
814
815         US_DEBUGP("Leaving isd200_atapi_soft_reset %08X\n", retStatus);
816         return retStatus;
817 }
818
819
820 /**************************************************************************
821  * isd200_srst
822  *                                                                       
823  * Perform an SRST on the device
824  *
825  * RETURNS:
826  *    ISD status code
827  */
828 static int isd200_srst( struct us_data *us ) 
829 {
830         int retStatus = ISD200_GOOD;
831         int transferStatus;
832
833         US_DEBUGP("Entering isd200_SRST\n");
834
835         transferStatus = isd200_action( us, ACTION_RESET, NULL, 0 );
836
837         /* check to see if this request failed */
838         if (transferStatus != ISD200_TRANSPORT_GOOD) {
839                 US_DEBUGP("   Error issuing SRST\n");
840                 retStatus = ISD200_ERROR;
841         } else {
842                 /* delay 10ms to give the drive a chance to see it */
843                 msleep(10);
844
845                 transferStatus = isd200_action( us, ACTION_REENABLE, NULL, 0 );
846                 if (transferStatus != ISD200_TRANSPORT_GOOD) {
847                         US_DEBUGP("   Error taking drive out of reset\n");
848                         retStatus = ISD200_ERROR;
849                 } else {
850                         /* delay 50ms to give the drive a chance to recover after SRST */
851                         msleep(50);
852                 }
853         }
854
855         US_DEBUGP("Leaving isd200_srst %08X\n", retStatus);
856         return retStatus;
857 }
858
859
860 /**************************************************************************
861  * isd200_try_enum
862  *                                                                       
863  * Helper function for isd200_manual_enum(). Does ENUM and READ_STATUS
864  * and tries to analyze the status registers
865  *
866  * RETURNS:
867  *    ISD status code
868  */
869 static int isd200_try_enum(struct us_data *us, unsigned char master_slave,
870                            int detect )
871 {
872         int status = ISD200_GOOD;
873         unsigned long endTime;
874         struct isd200_info *info = (struct isd200_info *)us->extra;
875         unsigned char *regs = info->RegsBuf;
876         int recheckAsMaster = 0;
877
878         if ( detect )
879                 endTime = jiffies + ISD200_ENUM_DETECT_TIMEOUT * HZ;
880         else
881                 endTime = jiffies + ISD200_ENUM_BSY_TIMEOUT * HZ;
882
883         /* loop until we detect !BSY or timeout */
884         while(1) {
885 #ifdef CONFIG_USB_STORAGE_DEBUG
886                 char* mstr = master_slave == ATA_ADDRESS_DEVHEAD_STD ?
887                         "Master" : "Slave";
888 #endif
889
890                 status = isd200_action( us, ACTION_ENUM, NULL, master_slave );
891                 if ( status != ISD200_GOOD )
892                         break;
893
894                 status = isd200_action( us, ACTION_READ_STATUS, 
895                                         regs, 8 );
896                 if ( status != ISD200_GOOD )
897                         break;
898
899                 if (!detect) {
900                         if (regs[ATA_REG_STATUS_OFFSET] & BUSY_STAT) {
901                                 US_DEBUGP("   %s status is still BSY, try again...\n",mstr);
902                         } else {
903                                 US_DEBUGP("   %s status !BSY, continue with next operation\n",mstr);
904                                 break;
905                         }
906                 }
907                 /* check for BUSY_STAT and */
908                 /* WRERR_STAT (workaround ATA Zip drive) and */ 
909                 /* ERR_STAT (workaround for Archos CD-ROM) */
910                 else if (regs[ATA_REG_STATUS_OFFSET] &
911                          (BUSY_STAT | WRERR_STAT | ERR_STAT )) {
912                         US_DEBUGP("   Status indicates it is not ready, try again...\n");
913                 }
914                 /* check for DRDY, ATA devices set DRDY after SRST */
915                 else if (regs[ATA_REG_STATUS_OFFSET] & READY_STAT) {
916                         US_DEBUGP("   Identified ATA device\n");
917                         info->DeviceFlags |= DF_ATA_DEVICE;
918                         info->DeviceHead = master_slave;
919                         break;
920                 } 
921                 /* check Cylinder High/Low to
922                    determine if it is an ATAPI device
923                 */
924                 else if (regs[ATA_REG_HCYL_OFFSET] == 0xEB &&
925                          regs[ATA_REG_LCYL_OFFSET] == 0x14) {
926                         /* It seems that the RICOH 
927                            MP6200A CD/RW drive will 
928                            report itself okay as a
929                            slave when it is really a
930                            master. So this check again
931                            as a master device just to
932                            make sure it doesn't report
933                            itself okay as a master also
934                         */
935                         if ((master_slave & ATA_ADDRESS_DEVHEAD_SLAVE) &&
936                             !recheckAsMaster) {
937                                 US_DEBUGP("   Identified ATAPI device as slave.  Rechecking again as master\n");
938                                 recheckAsMaster = 1;
939                                 master_slave = ATA_ADDRESS_DEVHEAD_STD;
940                         } else {
941                                 US_DEBUGP("   Identified ATAPI device\n");
942                                 info->DeviceHead = master_slave;
943                               
944                                 status = isd200_atapi_soft_reset(us);
945                                 break;
946                         }
947                 } else {
948                         US_DEBUGP("   Not ATA, not ATAPI. Weird.\n");
949                         break;
950                 }
951
952                 /* check for timeout on this request */
953                 if (time_after_eq(jiffies, endTime)) {
954                         if (!detect)
955                                 US_DEBUGP("   BSY check timeout, just continue with next operation...\n");
956                         else
957                                 US_DEBUGP("   Device detect timeout!\n");
958                         break;
959                 }
960         }
961
962         return status;
963 }
964
965 /**************************************************************************
966  * isd200_manual_enum
967  *                                                                       
968  * Determines if the drive attached is an ATA or ATAPI and if it is a
969  * master or slave.
970  *
971  * RETURNS:
972  *    ISD status code
973  */
974 static int isd200_manual_enum(struct us_data *us)
975 {
976         struct isd200_info *info = (struct isd200_info *)us->extra;
977         int retStatus = ISD200_GOOD;
978
979         US_DEBUGP("Entering isd200_manual_enum\n");
980
981         retStatus = isd200_read_config(us);
982         if (retStatus == ISD200_GOOD) {
983                 int isslave;
984                 /* master or slave? */
985                 retStatus = isd200_try_enum( us, ATA_ADDRESS_DEVHEAD_STD, 0);
986                 if (retStatus == ISD200_GOOD)
987                         retStatus = isd200_try_enum( us, ATA_ADDRESS_DEVHEAD_SLAVE, 0);
988
989                 if (retStatus == ISD200_GOOD) {
990                         retStatus = isd200_srst(us);
991                         if (retStatus == ISD200_GOOD)
992                                 /* ata or atapi? */
993                                 retStatus = isd200_try_enum( us, ATA_ADDRESS_DEVHEAD_STD, 1);
994                 }
995
996                 isslave = (info->DeviceHead & ATA_ADDRESS_DEVHEAD_SLAVE) ? 1 : 0;
997                 if (!(info->ConfigData.ATAConfig & ATACFG_MASTER)) {
998                         US_DEBUGP("   Setting Master/Slave selection to %d\n", isslave);
999                         info->ConfigData.ATAConfig &= 0x3f;
1000                         info->ConfigData.ATAConfig |= (isslave<<6);
1001                         retStatus = isd200_write_config(us);
1002                 }
1003         }
1004
1005         US_DEBUGP("Leaving isd200_manual_enum %08X\n", retStatus);
1006         return(retStatus);
1007 }
1008
1009 static void isd200_fix_driveid (struct hd_driveid *id)
1010 {
1011 #ifndef __LITTLE_ENDIAN
1012 # ifdef __BIG_ENDIAN
1013         int i;
1014         u16 *stringcast;
1015
1016         id->config         = __le16_to_cpu(id->config);
1017         id->cyls           = __le16_to_cpu(id->cyls);
1018         id->reserved2      = __le16_to_cpu(id->reserved2);
1019         id->heads          = __le16_to_cpu(id->heads);
1020         id->track_bytes    = __le16_to_cpu(id->track_bytes);
1021         id->sector_bytes   = __le16_to_cpu(id->sector_bytes);
1022         id->sectors        = __le16_to_cpu(id->sectors);
1023         id->vendor0        = __le16_to_cpu(id->vendor0);
1024         id->vendor1        = __le16_to_cpu(id->vendor1);
1025         id->vendor2        = __le16_to_cpu(id->vendor2);
1026         stringcast = (u16 *)&id->serial_no[0];
1027         for (i = 0; i < (20/2); i++)
1028                 stringcast[i] = __le16_to_cpu(stringcast[i]);
1029         id->buf_type       = __le16_to_cpu(id->buf_type);
1030         id->buf_size       = __le16_to_cpu(id->buf_size);
1031         id->ecc_bytes      = __le16_to_cpu(id->ecc_bytes);
1032         stringcast = (u16 *)&id->fw_rev[0];
1033         for (i = 0; i < (8/2); i++)
1034                 stringcast[i] = __le16_to_cpu(stringcast[i]);
1035         stringcast = (u16 *)&id->model[0];
1036         for (i = 0; i < (40/2); i++)
1037                 stringcast[i] = __le16_to_cpu(stringcast[i]);
1038         id->dword_io       = __le16_to_cpu(id->dword_io);
1039         id->reserved50     = __le16_to_cpu(id->reserved50);
1040         id->field_valid    = __le16_to_cpu(id->field_valid);
1041         id->cur_cyls       = __le16_to_cpu(id->cur_cyls);
1042         id->cur_heads      = __le16_to_cpu(id->cur_heads);
1043         id->cur_sectors    = __le16_to_cpu(id->cur_sectors);
1044         id->cur_capacity0  = __le16_to_cpu(id->cur_capacity0);
1045         id->cur_capacity1  = __le16_to_cpu(id->cur_capacity1);
1046         id->lba_capacity   = __le32_to_cpu(id->lba_capacity);
1047         id->dma_1word      = __le16_to_cpu(id->dma_1word);
1048         id->dma_mword      = __le16_to_cpu(id->dma_mword);
1049         id->eide_pio_modes = __le16_to_cpu(id->eide_pio_modes);
1050         id->eide_dma_min   = __le16_to_cpu(id->eide_dma_min);
1051         id->eide_dma_time  = __le16_to_cpu(id->eide_dma_time);
1052         id->eide_pio       = __le16_to_cpu(id->eide_pio);
1053         id->eide_pio_iordy = __le16_to_cpu(id->eide_pio_iordy);
1054         for (i = 0; i < 2; ++i)
1055                 id->words69_70[i] = __le16_to_cpu(id->words69_70[i]);
1056         for (i = 0; i < 4; ++i)
1057                 id->words71_74[i] = __le16_to_cpu(id->words71_74[i]);
1058         id->queue_depth    = __le16_to_cpu(id->queue_depth);
1059         for (i = 0; i < 4; ++i)
1060                 id->words76_79[i] = __le16_to_cpu(id->words76_79[i]);
1061         id->major_rev_num  = __le16_to_cpu(id->major_rev_num);
1062         id->minor_rev_num  = __le16_to_cpu(id->minor_rev_num);
1063         id->command_set_1  = __le16_to_cpu(id->command_set_1);
1064         id->command_set_2  = __le16_to_cpu(id->command_set_2);
1065         id->cfsse          = __le16_to_cpu(id->cfsse);
1066         id->cfs_enable_1   = __le16_to_cpu(id->cfs_enable_1);
1067         id->cfs_enable_2   = __le16_to_cpu(id->cfs_enable_2);
1068         id->csf_default    = __le16_to_cpu(id->csf_default);
1069         id->dma_ultra      = __le16_to_cpu(id->dma_ultra);
1070         id->trseuc         = __le16_to_cpu(id->trseuc);
1071         id->trsEuc         = __le16_to_cpu(id->trsEuc);
1072         id->CurAPMvalues   = __le16_to_cpu(id->CurAPMvalues);
1073         id->mprc           = __le16_to_cpu(id->mprc);
1074         id->hw_config      = __le16_to_cpu(id->hw_config);
1075         id->acoustic       = __le16_to_cpu(id->acoustic);
1076         id->msrqs          = __le16_to_cpu(id->msrqs);
1077         id->sxfert         = __le16_to_cpu(id->sxfert);
1078         id->sal            = __le16_to_cpu(id->sal);
1079         id->spg            = __le32_to_cpu(id->spg);
1080         id->lba_capacity_2 = __le64_to_cpu(id->lba_capacity_2);
1081         for (i = 0; i < 22; i++)
1082                 id->words104_125[i]   = __le16_to_cpu(id->words104_125[i]);
1083         id->last_lun       = __le16_to_cpu(id->last_lun);
1084         id->word127        = __le16_to_cpu(id->word127);
1085         id->dlf            = __le16_to_cpu(id->dlf);
1086         id->csfo           = __le16_to_cpu(id->csfo);
1087         for (i = 0; i < 26; i++)
1088                 id->words130_155[i] = __le16_to_cpu(id->words130_155[i]);
1089         id->word156        = __le16_to_cpu(id->word156);
1090         for (i = 0; i < 3; i++)
1091                 id->words157_159[i] = __le16_to_cpu(id->words157_159[i]);
1092         id->cfa_power      = __le16_to_cpu(id->cfa_power);
1093         for (i = 0; i < 14; i++)
1094                 id->words161_175[i] = __le16_to_cpu(id->words161_175[i]);
1095         for (i = 0; i < 31; i++)
1096                 id->words176_205[i] = __le16_to_cpu(id->words176_205[i]);
1097         for (i = 0; i < 48; i++)
1098                 id->words206_254[i] = __le16_to_cpu(id->words206_254[i]);
1099         id->integrity_word  = __le16_to_cpu(id->integrity_word);
1100 # else
1101 #  error "Please fix <asm/byteorder.h>"
1102 # endif
1103 #endif
1104 }
1105
1106
1107 /**************************************************************************
1108  * isd200_get_inquiry_data
1109  *
1110  * Get inquiry data
1111  *
1112  * RETURNS:
1113  *    ISD status code
1114  */
1115 static int isd200_get_inquiry_data( struct us_data *us )
1116 {
1117         struct isd200_info *info = (struct isd200_info *)us->extra;
1118         int retStatus = ISD200_GOOD;
1119         struct hd_driveid *id = info->id;
1120
1121         US_DEBUGP("Entering isd200_get_inquiry_data\n");
1122
1123         /* set default to Master */
1124         info->DeviceHead = ATA_ADDRESS_DEVHEAD_STD;
1125
1126         /* attempt to manually enumerate this device */
1127         retStatus = isd200_manual_enum(us);
1128         if (retStatus == ISD200_GOOD) {
1129                 int transferStatus;
1130
1131                 /* check for an ATA device */
1132                 if (info->DeviceFlags & DF_ATA_DEVICE) {
1133                         /* this must be an ATA device */
1134                         /* perform an ATA Command Identify */
1135                         transferStatus = isd200_action( us, ACTION_IDENTIFY,
1136                                                         id, 
1137                                                         sizeof(struct hd_driveid) );
1138                         if (transferStatus != ISD200_TRANSPORT_GOOD) {
1139                                 /* Error issuing ATA Command Identify */
1140                                 US_DEBUGP("   Error issuing ATA Command Identify\n");
1141                                 retStatus = ISD200_ERROR;
1142                         } else {
1143                                 /* ATA Command Identify successful */
1144                                 int i;
1145                                 __be16 *src;
1146                                 __u16 *dest;
1147                                 isd200_fix_driveid(id);
1148
1149                                 US_DEBUGP("   Identify Data Structure:\n");
1150                                 US_DEBUGP("      config = 0x%x\n", id->config);
1151                                 US_DEBUGP("      cyls = 0x%x\n", id->cyls);
1152                                 US_DEBUGP("      heads = 0x%x\n", id->heads);
1153                                 US_DEBUGP("      track_bytes = 0x%x\n", id->track_bytes);
1154                                 US_DEBUGP("      sector_bytes = 0x%x\n", id->sector_bytes);
1155                                 US_DEBUGP("      sectors = 0x%x\n", id->sectors);
1156                                 US_DEBUGP("      serial_no[0] = 0x%x\n", id->serial_no[0]);
1157                                 US_DEBUGP("      buf_type = 0x%x\n", id->buf_type);
1158                                 US_DEBUGP("      buf_size = 0x%x\n", id->buf_size);
1159                                 US_DEBUGP("      ecc_bytes = 0x%x\n", id->ecc_bytes);
1160                                 US_DEBUGP("      fw_rev[0] = 0x%x\n", id->fw_rev[0]);
1161                                 US_DEBUGP("      model[0] = 0x%x\n", id->model[0]);
1162                                 US_DEBUGP("      max_multsect = 0x%x\n", id->max_multsect);
1163                                 US_DEBUGP("      dword_io = 0x%x\n", id->dword_io);
1164                                 US_DEBUGP("      capability = 0x%x\n", id->capability);
1165                                 US_DEBUGP("      tPIO = 0x%x\n", id->tPIO);
1166                                 US_DEBUGP("      tDMA = 0x%x\n", id->tDMA);
1167                                 US_DEBUGP("      field_valid = 0x%x\n", id->field_valid);
1168                                 US_DEBUGP("      cur_cyls = 0x%x\n", id->cur_cyls);
1169                                 US_DEBUGP("      cur_heads = 0x%x\n", id->cur_heads);
1170                                 US_DEBUGP("      cur_sectors = 0x%x\n", id->cur_sectors);
1171                                 US_DEBUGP("      cur_capacity = 0x%x\n", (id->cur_capacity1 << 16) + id->cur_capacity0 );
1172                                 US_DEBUGP("      multsect = 0x%x\n", id->multsect);
1173                                 US_DEBUGP("      lba_capacity = 0x%x\n", id->lba_capacity);
1174                                 US_DEBUGP("      command_set_1 = 0x%x\n", id->command_set_1);
1175                                 US_DEBUGP("      command_set_2 = 0x%x\n", id->command_set_2);
1176
1177                                 memset(&info->InquiryData, 0, sizeof(info->InquiryData));
1178
1179                                 /* Standard IDE interface only supports disks */
1180                                 info->InquiryData.DeviceType = DIRECT_ACCESS_DEVICE;
1181
1182                                 /* The length must be at least 36 (5 + 31) */
1183                                 info->InquiryData.AdditionalLength = 0x1F;
1184
1185                                 if (id->command_set_1 & COMMANDSET_MEDIA_STATUS) {
1186                                         /* set the removable bit */
1187                                         info->InquiryData.DeviceTypeModifier = DEVICE_REMOVABLE;
1188                                         info->DeviceFlags |= DF_REMOVABLE_MEDIA;
1189                                 }
1190
1191                                 /* Fill in vendor identification fields */
1192                                 src = (__be16*)id->model;
1193                                 dest = (__u16*)info->InquiryData.VendorId;
1194                                 for (i=0;i<4;i++)
1195                                         dest[i] = be16_to_cpu(src[i]);
1196
1197                                 src = (__be16*)(id->model+8);
1198                                 dest = (__u16*)info->InquiryData.ProductId;
1199                                 for (i=0;i<8;i++)
1200                                         dest[i] = be16_to_cpu(src[i]);
1201
1202                                 src = (__be16*)id->fw_rev;
1203                                 dest = (__u16*)info->InquiryData.ProductRevisionLevel;
1204                                 for (i=0;i<2;i++)
1205                                         dest[i] = be16_to_cpu(src[i]);
1206
1207                                 /* determine if it supports Media Status Notification */
1208                                 if (id->command_set_2 & COMMANDSET_MEDIA_STATUS) {
1209                                         US_DEBUGP("   Device supports Media Status Notification\n");
1210
1211                                         /* Indicate that it is enabled, even though it is not
1212                                          * This allows the lock/unlock of the media to work
1213                                          * correctly.
1214                                          */
1215                                         info->DeviceFlags |= DF_MEDIA_STATUS_ENABLED;
1216                                 }
1217                                 else
1218                                         info->DeviceFlags &= ~DF_MEDIA_STATUS_ENABLED;
1219
1220                         }
1221                 } else {
1222                         /* 
1223                          * this must be an ATAPI device 
1224                          * use an ATAPI protocol (Transparent SCSI)
1225                          */
1226                         us->protocol_name = "Transparent SCSI";
1227                         us->proto_handler = usb_stor_transparent_scsi_command;
1228
1229                         US_DEBUGP("Protocol changed to: %s\n", us->protocol_name);
1230             
1231                         /* Free driver structure */         
1232                         us->extra_destructor(info);
1233                         us->extra = NULL;
1234                         us->extra_destructor = NULL;
1235                 }
1236         }
1237
1238         US_DEBUGP("Leaving isd200_get_inquiry_data %08X\n", retStatus);
1239
1240         return(retStatus);
1241 }
1242
1243 /**************************************************************************
1244  * isd200_scsi_to_ata
1245  *                                                                       
1246  * Translate SCSI commands to ATA commands.
1247  *
1248  * RETURNS:
1249  *    1 if the command needs to be sent to the transport layer
1250  *    0 otherwise
1251  */
1252 static int isd200_scsi_to_ata(struct scsi_cmnd *srb, struct us_data *us,
1253                               union ata_cdb * ataCdb)
1254 {
1255         struct isd200_info *info = (struct isd200_info *)us->extra;
1256         struct hd_driveid *id = info->id;
1257         int sendToTransport = 1;
1258         unsigned char sectnum, head;
1259         unsigned short cylinder;
1260         unsigned long lba;
1261         unsigned long blockCount;
1262         unsigned char senseData[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
1263
1264         memset(ataCdb, 0, sizeof(union ata_cdb));
1265
1266         /* SCSI Command */
1267         switch (srb->cmnd[0]) {
1268         case INQUIRY:
1269                 US_DEBUGP("   ATA OUT - INQUIRY\n");
1270
1271                 /* copy InquiryData */
1272                 usb_stor_set_xfer_buf((unsigned char *) &info->InquiryData,
1273                                 sizeof(info->InquiryData), srb);
1274                 srb->result = SAM_STAT_GOOD;
1275                 sendToTransport = 0;
1276                 break;
1277
1278         case MODE_SENSE:
1279                 US_DEBUGP("   ATA OUT - SCSIOP_MODE_SENSE\n");
1280
1281                 /* Initialize the return buffer */
1282                 usb_stor_set_xfer_buf(senseData, sizeof(senseData), srb);
1283
1284                 if (info->DeviceFlags & DF_MEDIA_STATUS_ENABLED)
1285                 {
1286                         ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1287                         ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1288                         ataCdb->generic.TransferBlockSize = 1;
1289                         ataCdb->generic.RegisterSelect = REG_COMMAND;
1290                         ataCdb->write.CommandByte = ATA_COMMAND_GET_MEDIA_STATUS;
1291                         isd200_srb_set_bufflen(srb, 0);
1292                 } else {
1293                         US_DEBUGP("   Media Status not supported, just report okay\n");
1294                         srb->result = SAM_STAT_GOOD;
1295                         sendToTransport = 0;
1296                 }
1297                 break;
1298
1299         case TEST_UNIT_READY:
1300                 US_DEBUGP("   ATA OUT - SCSIOP_TEST_UNIT_READY\n");
1301
1302                 if (info->DeviceFlags & DF_MEDIA_STATUS_ENABLED)
1303                 {
1304                         ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1305                         ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1306                         ataCdb->generic.TransferBlockSize = 1;
1307                         ataCdb->generic.RegisterSelect = REG_COMMAND;
1308                         ataCdb->write.CommandByte = ATA_COMMAND_GET_MEDIA_STATUS;
1309                         isd200_srb_set_bufflen(srb, 0);
1310                 } else {
1311                         US_DEBUGP("   Media Status not supported, just report okay\n");
1312                         srb->result = SAM_STAT_GOOD;
1313                         sendToTransport = 0;
1314                 }
1315                 break;
1316
1317         case READ_CAPACITY:
1318         {
1319                 unsigned long capacity;
1320                 struct read_capacity_data readCapacityData;
1321
1322                 US_DEBUGP("   ATA OUT - SCSIOP_READ_CAPACITY\n");
1323
1324                 if (id->capability & CAPABILITY_LBA ) {
1325                         capacity = id->lba_capacity - 1;
1326                 } else {
1327                         capacity = (id->heads *
1328                                     id->cyls *
1329                                     id->sectors) - 1;
1330                 }
1331                 readCapacityData.LogicalBlockAddress = cpu_to_be32(capacity);
1332                 readCapacityData.BytesPerBlock = cpu_to_be32(0x200);
1333
1334                 usb_stor_set_xfer_buf((unsigned char *) &readCapacityData,
1335                                 sizeof(readCapacityData), srb);
1336                 srb->result = SAM_STAT_GOOD;
1337                 sendToTransport = 0;
1338         }
1339         break;
1340
1341         case READ_10:
1342                 US_DEBUGP("   ATA OUT - SCSIOP_READ\n");
1343
1344                 lba = be32_to_cpu(*(__be32 *)&srb->cmnd[2]);
1345                 blockCount = (unsigned long)srb->cmnd[7]<<8 | (unsigned long)srb->cmnd[8];
1346
1347                 if (id->capability & CAPABILITY_LBA) {
1348                         sectnum = (unsigned char)(lba);
1349                         cylinder = (unsigned short)(lba>>8);
1350                         head = ATA_ADDRESS_DEVHEAD_LBA_MODE | (unsigned char)(lba>>24 & 0x0F);
1351                 } else {
1352                         sectnum = (unsigned char)((lba % id->sectors) + 1);
1353                         cylinder = (unsigned short)(lba / (id->sectors *
1354                                                            id->heads));
1355                         head = (unsigned char)((lba / id->sectors) %
1356                                                id->heads);
1357                 }
1358                 ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1359                 ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1360                 ataCdb->generic.TransferBlockSize = 1;
1361                 ataCdb->generic.RegisterSelect =
1362                   REG_SECTOR_COUNT | REG_SECTOR_NUMBER |
1363                   REG_CYLINDER_LOW | REG_CYLINDER_HIGH |
1364                   REG_DEVICE_HEAD  | REG_COMMAND;
1365                 ataCdb->write.SectorCountByte = (unsigned char)blockCount;
1366                 ataCdb->write.SectorNumberByte = sectnum;
1367                 ataCdb->write.CylinderHighByte = (unsigned char)(cylinder>>8);
1368                 ataCdb->write.CylinderLowByte = (unsigned char)cylinder;
1369                 ataCdb->write.DeviceHeadByte = (head | ATA_ADDRESS_DEVHEAD_STD);
1370                 ataCdb->write.CommandByte = WIN_READ;
1371                 break;
1372
1373         case WRITE_10:
1374                 US_DEBUGP("   ATA OUT - SCSIOP_WRITE\n");
1375
1376                 lba = be32_to_cpu(*(__be32 *)&srb->cmnd[2]);
1377                 blockCount = (unsigned long)srb->cmnd[7]<<8 | (unsigned long)srb->cmnd[8];
1378
1379                 if (id->capability & CAPABILITY_LBA) {
1380                         sectnum = (unsigned char)(lba);
1381                         cylinder = (unsigned short)(lba>>8);
1382                         head = ATA_ADDRESS_DEVHEAD_LBA_MODE | (unsigned char)(lba>>24 & 0x0F);
1383                 } else {
1384                         sectnum = (unsigned char)((lba % id->sectors) + 1);
1385                         cylinder = (unsigned short)(lba / (id->sectors * id->heads));
1386                         head = (unsigned char)((lba / id->sectors) % id->heads);
1387                 }
1388                 ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1389                 ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1390                 ataCdb->generic.TransferBlockSize = 1;
1391                 ataCdb->generic.RegisterSelect =
1392                   REG_SECTOR_COUNT | REG_SECTOR_NUMBER |
1393                   REG_CYLINDER_LOW | REG_CYLINDER_HIGH |
1394                   REG_DEVICE_HEAD  | REG_COMMAND;
1395                 ataCdb->write.SectorCountByte = (unsigned char)blockCount;
1396                 ataCdb->write.SectorNumberByte = sectnum;
1397                 ataCdb->write.CylinderHighByte = (unsigned char)(cylinder>>8);
1398                 ataCdb->write.CylinderLowByte = (unsigned char)cylinder;
1399                 ataCdb->write.DeviceHeadByte = (head | ATA_ADDRESS_DEVHEAD_STD);
1400                 ataCdb->write.CommandByte = WIN_WRITE;
1401                 break;
1402
1403         case ALLOW_MEDIUM_REMOVAL:
1404                 US_DEBUGP("   ATA OUT - SCSIOP_MEDIUM_REMOVAL\n");
1405
1406                 if (info->DeviceFlags & DF_REMOVABLE_MEDIA) {
1407                         US_DEBUGP("   srb->cmnd[4] = 0x%X\n", srb->cmnd[4]);
1408             
1409                         ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1410                         ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1411                         ataCdb->generic.TransferBlockSize = 1;
1412                         ataCdb->generic.RegisterSelect = REG_COMMAND;
1413                         ataCdb->write.CommandByte = (srb->cmnd[4] & 0x1) ?
1414                                 WIN_DOORLOCK : WIN_DOORUNLOCK;
1415                         isd200_srb_set_bufflen(srb, 0);
1416                 } else {
1417                         US_DEBUGP("   Not removeable media, just report okay\n");
1418                         srb->result = SAM_STAT_GOOD;
1419                         sendToTransport = 0;
1420                 }
1421                 break;
1422
1423         case START_STOP:    
1424                 US_DEBUGP("   ATA OUT - SCSIOP_START_STOP_UNIT\n");
1425                 US_DEBUGP("   srb->cmnd[4] = 0x%X\n", srb->cmnd[4]);
1426
1427                 if ((srb->cmnd[4] & 0x3) == 0x2) {
1428                         US_DEBUGP("   Media Eject\n");
1429                         ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1430                         ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1431                         ataCdb->generic.TransferBlockSize = 0;
1432                         ataCdb->generic.RegisterSelect = REG_COMMAND;
1433                         ataCdb->write.CommandByte = ATA_COMMAND_MEDIA_EJECT;
1434                 } else if ((srb->cmnd[4] & 0x3) == 0x1) {
1435                         US_DEBUGP("   Get Media Status\n");
1436                         ataCdb->generic.SignatureByte0 = info->ConfigData.ATAMajorCommand;
1437                         ataCdb->generic.SignatureByte1 = info->ConfigData.ATAMinorCommand;
1438                         ataCdb->generic.TransferBlockSize = 1;
1439                         ataCdb->generic.RegisterSelect = REG_COMMAND;
1440                         ataCdb->write.CommandByte = ATA_COMMAND_GET_MEDIA_STATUS;
1441                         isd200_srb_set_bufflen(srb, 0);
1442                 } else {
1443                         US_DEBUGP("   Nothing to do, just report okay\n");
1444                         srb->result = SAM_STAT_GOOD;
1445                         sendToTransport = 0;
1446                 }
1447                 break;
1448
1449         default:
1450                 US_DEBUGP("Unsupported SCSI command - 0x%X\n", srb->cmnd[0]);
1451                 srb->result = DID_ERROR << 16;
1452                 sendToTransport = 0;
1453                 break;
1454         }
1455
1456         return(sendToTransport);
1457 }
1458
1459
1460 /**************************************************************************
1461  * isd200_free_info
1462  *
1463  * Frees the driver structure.
1464  */
1465 static void isd200_free_info_ptrs(void *info_)
1466 {
1467         struct isd200_info *info = (struct isd200_info *) info_;
1468
1469         if (info) {
1470                 kfree(info->id);
1471                 kfree(info->RegsBuf);
1472         }
1473 }
1474
1475 /**************************************************************************
1476  * isd200_init_info
1477  *                                                                       
1478  * Allocates (if necessary) and initializes the driver structure.
1479  *
1480  * RETURNS:
1481  *    ISD status code
1482  */
1483 static int isd200_init_info(struct us_data *us)
1484 {
1485         int retStatus = ISD200_GOOD;
1486         struct isd200_info *info;
1487
1488         info = (struct isd200_info *)
1489                         kzalloc(sizeof(struct isd200_info), GFP_KERNEL);
1490         if (!info)
1491                 retStatus = ISD200_ERROR;
1492         else {
1493                 info->id = (struct hd_driveid *)
1494                                 kzalloc(sizeof(struct hd_driveid), GFP_KERNEL);
1495                 info->RegsBuf = (unsigned char *)
1496                                 kmalloc(sizeof(info->ATARegs), GFP_KERNEL);
1497                 if (!info->id || !info->RegsBuf) {
1498                         isd200_free_info_ptrs(info);
1499                         kfree(info);
1500                         retStatus = ISD200_ERROR;
1501                 }
1502         }
1503
1504         if (retStatus == ISD200_GOOD) {
1505                 us->extra = info;
1506                 us->extra_destructor = isd200_free_info_ptrs;
1507         } else
1508                 US_DEBUGP("ERROR - kmalloc failure\n");
1509
1510         return retStatus;
1511 }
1512
1513 /**************************************************************************
1514  * Initialization for the ISD200 
1515  */
1516
1517 int isd200_Initialization(struct us_data *us)
1518 {
1519         US_DEBUGP("ISD200 Initialization...\n");
1520
1521         /* Initialize ISD200 info struct */
1522
1523         if (isd200_init_info(us) == ISD200_ERROR) {
1524                 US_DEBUGP("ERROR Initializing ISD200 Info struct\n");
1525         } else {
1526                 /* Get device specific data */
1527
1528                 if (isd200_get_inquiry_data(us) != ISD200_GOOD)
1529                         US_DEBUGP("ISD200 Initialization Failure\n");
1530                 else
1531                         US_DEBUGP("ISD200 Initialization complete\n");
1532         }
1533
1534         return 0;
1535 }
1536
1537
1538 /**************************************************************************
1539  * Protocol and Transport for the ISD200 ASIC
1540  *
1541  * This protocol and transport are for ATA devices connected to an ISD200
1542  * ASIC.  An ATAPI device that is conected as a slave device will be
1543  * detected in the driver initialization function and the protocol will
1544  * be changed to an ATAPI protocol (Transparent SCSI).
1545  *
1546  */
1547
1548 void isd200_ata_command(struct scsi_cmnd *srb, struct us_data *us)
1549 {
1550         int sendToTransport = 1, orig_bufflen;
1551         union ata_cdb ataCdb;
1552
1553         /* Make sure driver was initialized */
1554
1555         if (us->extra == NULL)
1556                 US_DEBUGP("ERROR Driver not initialized\n");
1557
1558         scsi_set_resid(srb, 0);
1559         /* scsi_bufflen might change in protocol translation to ata */
1560         orig_bufflen = scsi_bufflen(srb);
1561         sendToTransport = isd200_scsi_to_ata(srb, us, &ataCdb);
1562
1563         /* send the command to the transport layer */
1564         if (sendToTransport)
1565                 isd200_invoke_transport(us, srb, &ataCdb);
1566
1567         isd200_srb_set_bufflen(srb, orig_bufflen);
1568 }