12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679 |
- /* Driver for SCM Microsystems USB-ATAPI cable
- *
- * $Id: shuttle_usbat.c,v 1.17 2002/04/22 03:39:43 mdharm Exp $
- *
- * Current development and maintenance by:
- * (c) 2000, 2001 Robert Baruch (autophile@starband.net)
- * (c) 2004, 2005 Daniel Drake <dsd@gentoo.org>
- *
- * Developed with the assistance of:
- * (c) 2002 Alan Stern <stern@rowland.org>
- *
- * Flash support based on earlier work by:
- * (c) 2002 Thomas Kreiling <usbdev@sm04.de>
- *
- * Many originally ATAPI devices were slightly modified to meet the USB
- * market by using some kind of translation from ATAPI to USB on the host,
- * and the peripheral would translate from USB back to ATAPI.
- *
- * SCM Microsystems (www.scmmicro.com) makes a device, sold to OEM's only,
- * which does the USB-to-ATAPI conversion. By obtaining the data sheet on
- * their device under nondisclosure agreement, I have been able to write
- * this driver for Linux.
- *
- * The chip used in the device can also be used for EPP and ISA translation
- * as well. This driver is only guaranteed to work with the ATAPI
- * translation.
- *
- * See the Kconfig help text for a list of devices known to be supported by
- * this driver.
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License as published by the
- * Free Software Foundation; either version 2, or (at your option) any
- * later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 675 Mass Ave, Cambridge, MA 02139, USA.
- */
- #include <linux/sched.h>
- #include <linux/errno.h>
- #include <linux/slab.h>
- #include <linux/cdrom.h>
- #include <scsi/scsi.h>
- #include <scsi/scsi_cmnd.h>
- #include "usb.h"
- #include "transport.h"
- #include "protocol.h"
- #include "debug.h"
- #include "shuttle_usbat.h"
- #define short_pack(LSB,MSB) ( ((u16)(LSB)) | ( ((u16)(MSB))<<8 ) )
- #define LSB_of(s) ((s)&0xFF)
- #define MSB_of(s) ((s)>>8)
- static int transferred = 0;
- static int usbat_flash_transport(struct scsi_cmnd * srb, struct us_data *us);
- static int usbat_hp8200e_transport(struct scsi_cmnd *srb, struct us_data *us);
- /*
- * Convenience function to produce an ATAPI read/write sectors command
- * Use cmd=0x20 for read, cmd=0x30 for write
- */
- static void usbat_pack_atapi_sector_cmd(unsigned char *buf,
- unsigned char thistime,
- u32 sector, unsigned char cmd)
- {
- buf[0] = 0;
- buf[1] = thistime;
- buf[2] = sector & 0xFF;
- buf[3] = (sector >> 8) & 0xFF;
- buf[4] = (sector >> 16) & 0xFF;
- buf[5] = 0xE0 | ((sector >> 24) & 0x0F);
- buf[6] = cmd;
- }
- /*
- * Convenience function to get the device type (flash or hp8200)
- */
- static int usbat_get_device_type(struct us_data *us)
- {
- return ((struct usbat_info*)us->extra)->devicetype;
- }
- /*
- * Read a register from the device
- */
- static int usbat_read(struct us_data *us,
- unsigned char access,
- unsigned char reg,
- unsigned char *content)
- {
- return usb_stor_ctrl_transfer(us,
- us->recv_ctrl_pipe,
- access | USBAT_CMD_READ_REG,
- 0xC0,
- (u16)reg,
- 0,
- content,
- 1);
- }
- /*
- * Write to a register on the device
- */
- static int usbat_write(struct us_data *us,
- unsigned char access,
- unsigned char reg,
- unsigned char content)
- {
- return usb_stor_ctrl_transfer(us,
- us->send_ctrl_pipe,
- access | USBAT_CMD_WRITE_REG,
- 0x40,
- short_pack(reg, content),
- 0,
- NULL,
- 0);
- }
- /*
- * Convenience function to perform a bulk read
- */
- static int usbat_bulk_read(struct us_data *us,
- unsigned char *data,
- unsigned int len)
- {
- if (len == 0)
- return USB_STOR_XFER_GOOD;
- US_DEBUGP("usbat_bulk_read: len = %d\n", len);
- return usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe, data, len, NULL);
- }
- /*
- * Convenience function to perform a bulk write
- */
- static int usbat_bulk_write(struct us_data *us,
- unsigned char *data,
- unsigned int len)
- {
- if (len == 0)
- return USB_STOR_XFER_GOOD;
- US_DEBUGP("usbat_bulk_write: len = %d\n", len);
- return usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe, data, len, NULL);
- }
- /*
- * Some USBAT-specific commands can only be executed over a command transport
- * This transport allows one (len=8) or two (len=16) vendor-specific commands
- * to be executed.
- */
- static int usbat_execute_command(struct us_data *us,
- unsigned char *commands,
- unsigned int len)
- {
- return usb_stor_ctrl_transfer(us, us->send_ctrl_pipe,
- USBAT_CMD_EXEC_CMD, 0x40, 0, 0,
- commands, len);
- }
- /*
- * Read the status register
- */
- static int usbat_get_status(struct us_data *us, unsigned char *status)
- {
- int rc;
- rc = usbat_read(us, USBAT_ATA, USBAT_ATA_STATUS, status);
- US_DEBUGP("usbat_get_status: 0x%02X\n", (unsigned short) (*status));
- return rc;
- }
- /*
- * Check the device status
- */
- static int usbat_check_status(struct us_data *us)
- {
- unsigned char *reply = us->iobuf;
- int rc;
- if (!us)
- return USB_STOR_TRANSPORT_ERROR;
- rc = usbat_get_status(us, reply);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_FAILED;
- if (*reply & 0x01 && *reply != 0x51) // error/check condition (0x51 is ok)
- return USB_STOR_TRANSPORT_FAILED;
- if (*reply & 0x20) // device fault
- return USB_STOR_TRANSPORT_FAILED;
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Stores critical information in internal registers in prepartion for the execution
- * of a conditional usbat_read_blocks or usbat_write_blocks call.
- */
- static int usbat_set_shuttle_features(struct us_data *us,
- unsigned char external_trigger,
- unsigned char epp_control,
- unsigned char mask_byte,
- unsigned char test_pattern,
- unsigned char subcountH,
- unsigned char subcountL)
- {
- unsigned char *command = us->iobuf;
- command[0] = 0x40;
- command[1] = USBAT_CMD_SET_FEAT;
- // The only bit relevant to ATA access is bit 6
- // which defines 8 bit data access (set) or 16 bit (unset)
- command[2] = epp_control;
- // If FCQ is set in the qualifier (defined in R/W cmd), then bits U0, U1,
- // ET1 and ET2 define an external event to be checked for on event of a
- // _read_blocks or _write_blocks operation. The read/write will not take
- // place unless the defined trigger signal is active.
- command[3] = external_trigger;
- // The resultant byte of the mask operation (see mask_byte) is compared for
- // equivalence with this test pattern. If equal, the read/write will take
- // place.
- command[4] = test_pattern;
- // This value is logically ANDed with the status register field specified
- // in the read/write command.
- command[5] = mask_byte;
- // If ALQ is set in the qualifier, this field contains the address of the
- // registers where the byte count should be read for transferring the data.
- // If ALQ is not set, then this field contains the number of bytes to be
- // transferred.
- command[6] = subcountL;
- command[7] = subcountH;
- return usbat_execute_command(us, command, 8);
- }
- /*
- * Block, waiting for an ATA device to become not busy or to report
- * an error condition.
- */
- static int usbat_wait_not_busy(struct us_data *us, int minutes)
- {
- int i;
- int result;
- unsigned char *status = us->iobuf;
- /* Synchronizing cache on a CDR could take a heck of a long time,
- * but probably not more than 10 minutes or so. On the other hand,
- * doing a full blank on a CDRW at speed 1 will take about 75
- * minutes!
- */
- for (i=0; i<1200+minutes*60; i++) {
- result = usbat_get_status(us, status);
- if (result!=USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (*status & 0x01) { // check condition
- result = usbat_read(us, USBAT_ATA, 0x10, status);
- return USB_STOR_TRANSPORT_FAILED;
- }
- if (*status & 0x20) // device fault
- return USB_STOR_TRANSPORT_FAILED;
- if ((*status & 0x80)==0x00) { // not busy
- US_DEBUGP("Waited not busy for %d steps\n", i);
- return USB_STOR_TRANSPORT_GOOD;
- }
- if (i<500)
- msleep(10); // 5 seconds
- else if (i<700)
- msleep(50); // 10 seconds
- else if (i<1200)
- msleep(100); // 50 seconds
- else
- msleep(1000); // X minutes
- }
- US_DEBUGP("Waited not busy for %d minutes, timing out.\n",
- minutes);
- return USB_STOR_TRANSPORT_FAILED;
- }
- /*
- * Read block data from the data register
- */
- static int usbat_read_block(struct us_data *us,
- unsigned char *content,
- unsigned short len)
- {
- int result;
- unsigned char *command = us->iobuf;
- if (!len)
- return USB_STOR_TRANSPORT_GOOD;
- command[0] = 0xC0;
- command[1] = USBAT_ATA | USBAT_CMD_READ_BLOCK;
- command[2] = USBAT_ATA_DATA;
- command[3] = 0;
- command[4] = 0;
- command[5] = 0;
- command[6] = LSB_of(len);
- command[7] = MSB_of(len);
- result = usbat_execute_command(us, command, 8);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- result = usbat_bulk_read(us, content, len);
- return (result == USB_STOR_XFER_GOOD ?
- USB_STOR_TRANSPORT_GOOD : USB_STOR_TRANSPORT_ERROR);
- }
- /*
- * Write block data via the data register
- */
- static int usbat_write_block(struct us_data *us,
- unsigned char access,
- unsigned char *content,
- unsigned short len,
- int minutes)
- {
- int result;
- unsigned char *command = us->iobuf;
- if (!len)
- return USB_STOR_TRANSPORT_GOOD;
- command[0] = 0x40;
- command[1] = access | USBAT_CMD_WRITE_BLOCK;
- command[2] = USBAT_ATA_DATA;
- command[3] = 0;
- command[4] = 0;
- command[5] = 0;
- command[6] = LSB_of(len);
- command[7] = MSB_of(len);
- result = usbat_execute_command(us, command, 8);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- result = usbat_bulk_write(us, content, len);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- return usbat_wait_not_busy(us, minutes);
- }
- /*
- * Process read and write requests
- */
- static int usbat_hp8200e_rw_block_test(struct us_data *us,
- unsigned char access,
- unsigned char *registers,
- unsigned char *data_out,
- unsigned short num_registers,
- unsigned char data_reg,
- unsigned char status_reg,
- unsigned char timeout,
- unsigned char qualifier,
- int direction,
- unsigned char *content,
- unsigned short len,
- int use_sg,
- int minutes)
- {
- int result;
- unsigned int pipe = (direction == DMA_FROM_DEVICE) ?
- us->recv_bulk_pipe : us->send_bulk_pipe;
- unsigned char *command = us->iobuf;
- int i, j;
- int cmdlen;
- unsigned char *data = us->iobuf;
- unsigned char *status = us->iobuf;
- BUG_ON(num_registers > US_IOBUF_SIZE/2);
- for (i=0; i<20; i++) {
- /*
- * The first time we send the full command, which consists
- * of downloading the SCSI command followed by downloading
- * the data via a write-and-test. Any other time we only
- * send the command to download the data -- the SCSI command
- * is still 'active' in some sense in the device.
- *
- * We're only going to try sending the data 10 times. After
- * that, we just return a failure.
- */
- if (i==0) {
- cmdlen = 16;
- // Write to multiple registers
- // Not really sure the 0x07, 0x17, 0xfc, 0xe7 is necessary here,
- // but that's what came out of the trace every single time.
- command[0] = 0x40;
- command[1] = access | USBAT_CMD_WRITE_REGS;
- command[2] = 0x07;
- command[3] = 0x17;
- command[4] = 0xFC;
- command[5] = 0xE7;
- command[6] = LSB_of(num_registers*2);
- command[7] = MSB_of(num_registers*2);
- } else
- cmdlen = 8;
- // Conditionally read or write blocks
- command[cmdlen-8] = (direction==DMA_TO_DEVICE ? 0x40 : 0xC0);
- command[cmdlen-7] = access |
- (direction==DMA_TO_DEVICE ?
- USBAT_CMD_COND_WRITE_BLOCK : USBAT_CMD_COND_READ_BLOCK);
- command[cmdlen-6] = data_reg;
- command[cmdlen-5] = status_reg;
- command[cmdlen-4] = timeout;
- command[cmdlen-3] = qualifier;
- command[cmdlen-2] = LSB_of(len);
- command[cmdlen-1] = MSB_of(len);
- result = usbat_execute_command(us, command, cmdlen);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (i==0) {
- for (j=0; j<num_registers; j++) {
- data[j<<1] = registers[j];
- data[1+(j<<1)] = data_out[j];
- }
- result = usbat_bulk_write(us, data, num_registers*2);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- }
- //US_DEBUGP("Transfer %s %d bytes, sg buffers %d\n",
- // direction == DMA_TO_DEVICE ? "out" : "in",
- // len, use_sg);
- result = usb_stor_bulk_transfer_sg(us,
- pipe, content, len, use_sg, NULL);
- /*
- * If we get a stall on the bulk download, we'll retry
- * the bulk download -- but not the SCSI command because
- * in some sense the SCSI command is still 'active' and
- * waiting for the data. Don't ask me why this should be;
- * I'm only following what the Windoze driver did.
- *
- * Note that a stall for the test-and-read/write command means
- * that the test failed. In this case we're testing to make
- * sure that the device is error-free
- * (i.e. bit 0 -- CHK -- of status is 0). The most likely
- * hypothesis is that the USBAT chip somehow knows what
- * the device will accept, but doesn't give the device any
- * data until all data is received. Thus, the device would
- * still be waiting for the first byte of data if a stall
- * occurs, even if the stall implies that some data was
- * transferred.
- */
- if (result == USB_STOR_XFER_SHORT ||
- result == USB_STOR_XFER_STALLED) {
- /*
- * If we're reading and we stalled, then clear
- * the bulk output pipe only the first time.
- */
- if (direction==DMA_FROM_DEVICE && i==0) {
- if (usb_stor_clear_halt(us,
- us->send_bulk_pipe) < 0)
- return USB_STOR_TRANSPORT_ERROR;
- }
- /*
- * Read status: is the device angry, or just busy?
- */
- result = usbat_read(us, USBAT_ATA,
- direction==DMA_TO_DEVICE ?
- USBAT_ATA_STATUS : USBAT_ATA_ALTSTATUS,
- status);
- if (result!=USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (*status & 0x01) // check condition
- return USB_STOR_TRANSPORT_FAILED;
- if (*status & 0x20) // device fault
- return USB_STOR_TRANSPORT_FAILED;
- US_DEBUGP("Redoing %s\n",
- direction==DMA_TO_DEVICE ? "write" : "read");
- } else if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- else
- return usbat_wait_not_busy(us, minutes);
- }
- US_DEBUGP("Bummer! %s bulk data 20 times failed.\n",
- direction==DMA_TO_DEVICE ? "Writing" : "Reading");
- return USB_STOR_TRANSPORT_FAILED;
- }
- /*
- * Write to multiple registers:
- * Allows us to write specific data to any registers. The data to be written
- * gets packed in this sequence: reg0, data0, reg1, data1, ..., regN, dataN
- * which gets sent through bulk out.
- * Not designed for large transfers of data!
- */
- static int usbat_multiple_write(struct us_data *us,
- unsigned char *registers,
- unsigned char *data_out,
- unsigned short num_registers)
- {
- int i, result;
- unsigned char *data = us->iobuf;
- unsigned char *command = us->iobuf;
- BUG_ON(num_registers > US_IOBUF_SIZE/2);
- // Write to multiple registers, ATA access
- command[0] = 0x40;
- command[1] = USBAT_ATA | USBAT_CMD_WRITE_REGS;
- // No relevance
- command[2] = 0;
- command[3] = 0;
- command[4] = 0;
- command[5] = 0;
- // Number of bytes to be transferred (incl. addresses and data)
- command[6] = LSB_of(num_registers*2);
- command[7] = MSB_of(num_registers*2);
- // The setup command
- result = usbat_execute_command(us, command, 8);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- // Create the reg/data, reg/data sequence
- for (i=0; i<num_registers; i++) {
- data[i<<1] = registers[i];
- data[1+(i<<1)] = data_out[i];
- }
- // Send the data
- result = usbat_bulk_write(us, data, num_registers*2);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_get_device_type(us) == USBAT_DEV_HP8200)
- return usbat_wait_not_busy(us, 0);
- else
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Conditionally read blocks from device:
- * Allows us to read blocks from a specific data register, based upon the
- * condition that a status register can be successfully masked with a status
- * qualifier. If this condition is not initially met, the read will wait
- * up until a maximum amount of time has elapsed, as specified by timeout.
- * The read will start when the condition is met, otherwise the command aborts.
- *
- * The qualifier defined here is not the value that is masked, it defines
- * conditions for the write to take place. The actual masked qualifier (and
- * other related details) are defined beforehand with _set_shuttle_features().
- */
- static int usbat_read_blocks(struct us_data *us,
- unsigned char *buffer,
- int len)
- {
- int result;
- unsigned char *command = us->iobuf;
- command[0] = 0xC0;
- command[1] = USBAT_ATA | USBAT_CMD_COND_READ_BLOCK;
- command[2] = USBAT_ATA_DATA;
- command[3] = USBAT_ATA_STATUS;
- command[4] = 0xFD; // Timeout (ms);
- command[5] = USBAT_QUAL_FCQ;
- command[6] = LSB_of(len);
- command[7] = MSB_of(len);
- // Multiple block read setup command
- result = usbat_execute_command(us, command, 8);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_FAILED;
-
- // Read the blocks we just asked for
- result = usbat_bulk_read(us, buffer, len);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_FAILED;
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Conditionally write blocks to device:
- * Allows us to write blocks to a specific data register, based upon the
- * condition that a status register can be successfully masked with a status
- * qualifier. If this condition is not initially met, the write will wait
- * up until a maximum amount of time has elapsed, as specified by timeout.
- * The read will start when the condition is met, otherwise the command aborts.
- *
- * The qualifier defined here is not the value that is masked, it defines
- * conditions for the write to take place. The actual masked qualifier (and
- * other related details) are defined beforehand with _set_shuttle_features().
- */
- static int usbat_write_blocks(struct us_data *us,
- unsigned char *buffer,
- int len)
- {
- int result;
- unsigned char *command = us->iobuf;
- command[0] = 0x40;
- command[1] = USBAT_ATA | USBAT_CMD_COND_WRITE_BLOCK;
- command[2] = USBAT_ATA_DATA;
- command[3] = USBAT_ATA_STATUS;
- command[4] = 0xFD; // Timeout (ms)
- command[5] = USBAT_QUAL_FCQ;
- command[6] = LSB_of(len);
- command[7] = MSB_of(len);
- // Multiple block write setup command
- result = usbat_execute_command(us, command, 8);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_FAILED;
-
- // Write the data
- result = usbat_bulk_write(us, buffer, len);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_FAILED;
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Read the User IO register
- */
- static int usbat_read_user_io(struct us_data *us, unsigned char *data_flags)
- {
- int result;
- result = usb_stor_ctrl_transfer(us,
- us->recv_ctrl_pipe,
- USBAT_CMD_UIO,
- 0xC0,
- 0,
- 0,
- data_flags,
- USBAT_UIO_READ);
- US_DEBUGP("usbat_read_user_io: UIO register reads %02X\n", (unsigned short) (*data_flags));
- return result;
- }
- /*
- * Write to the User IO register
- */
- static int usbat_write_user_io(struct us_data *us,
- unsigned char enable_flags,
- unsigned char data_flags)
- {
- return usb_stor_ctrl_transfer(us,
- us->send_ctrl_pipe,
- USBAT_CMD_UIO,
- 0x40,
- short_pack(enable_flags, data_flags),
- 0,
- NULL,
- USBAT_UIO_WRITE);
- }
- /*
- * Reset the device
- * Often needed on media change.
- */
- static int usbat_device_reset(struct us_data *us)
- {
- int rc;
- // Reset peripheral, enable peripheral control signals
- // (bring reset signal up)
- rc = usbat_write_user_io(us,
- USBAT_UIO_DRVRST | USBAT_UIO_OE1 | USBAT_UIO_OE0,
- USBAT_UIO_EPAD | USBAT_UIO_1);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
-
- // Enable peripheral control signals
- // (bring reset signal down)
- rc = usbat_write_user_io(us,
- USBAT_UIO_OE1 | USBAT_UIO_OE0,
- USBAT_UIO_EPAD | USBAT_UIO_1);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Enable card detect
- */
- static int usbat_device_enable_cdt(struct us_data *us)
- {
- int rc;
- // Enable peripheral control signals and card detect
- rc = usbat_write_user_io(us,
- USBAT_UIO_ACKD | USBAT_UIO_OE1 | USBAT_UIO_OE0,
- USBAT_UIO_EPAD | USBAT_UIO_1);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Determine if media is present.
- */
- static int usbat_flash_check_media_present(unsigned char *uio)
- {
- if (*uio & USBAT_UIO_UI0) {
- US_DEBUGP("usbat_flash_check_media_present: no media detected\n");
- return USBAT_FLASH_MEDIA_NONE;
- }
- return USBAT_FLASH_MEDIA_CF;
- }
- /*
- * Determine if media has changed since last operation
- */
- static int usbat_flash_check_media_changed(unsigned char *uio)
- {
- if (*uio & USBAT_UIO_0) {
- US_DEBUGP("usbat_flash_check_media_changed: media change detected\n");
- return USBAT_FLASH_MEDIA_CHANGED;
- }
- return USBAT_FLASH_MEDIA_SAME;
- }
- /*
- * Check for media change / no media and handle the situation appropriately
- */
- static int usbat_flash_check_media(struct us_data *us,
- struct usbat_info *info)
- {
- int rc;
- unsigned char *uio = us->iobuf;
- rc = usbat_read_user_io(us, uio);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- // Check for media existence
- rc = usbat_flash_check_media_present(uio);
- if (rc == USBAT_FLASH_MEDIA_NONE) {
- info->sense_key = 0x02;
- info->sense_asc = 0x3A;
- info->sense_ascq = 0x00;
- return USB_STOR_TRANSPORT_FAILED;
- }
- // Check for media change
- rc = usbat_flash_check_media_changed(uio);
- if (rc == USBAT_FLASH_MEDIA_CHANGED) {
- // Reset and re-enable card detect
- rc = usbat_device_reset(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- rc = usbat_device_enable_cdt(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- msleep(50);
- rc = usbat_read_user_io(us, uio);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
-
- info->sense_key = UNIT_ATTENTION;
- info->sense_asc = 0x28;
- info->sense_ascq = 0x00;
- return USB_STOR_TRANSPORT_FAILED;
- }
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Determine whether we are controlling a flash-based reader/writer,
- * or a HP8200-based CD drive.
- * Sets transport functions as appropriate.
- */
- static int usbat_identify_device(struct us_data *us,
- struct usbat_info *info)
- {
- int rc;
- unsigned char status;
- if (!us || !info)
- return USB_STOR_TRANSPORT_ERROR;
- rc = usbat_device_reset(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- msleep(25);
- /*
- * In attempt to distinguish between HP CDRW's and Flash readers, we now
- * execute the IDENTIFY PACKET DEVICE command. On ATA devices (i.e. flash
- * readers), this command should fail with error. On ATAPI devices (i.e.
- * CDROM drives), it should succeed.
- */
- rc = usbat_write(us, USBAT_ATA, USBAT_ATA_CMD, 0xA1);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- rc = usbat_get_status(us, &status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- // Check for error bit
- if (status & 0x01) {
- // Device is a CompactFlash reader/writer
- US_DEBUGP("usbat_identify_device: Detected Flash reader/writer\n");
- info->devicetype = USBAT_DEV_FLASH;
- } else {
- // Device is HP 8200
- US_DEBUGP("usbat_identify_device: Detected HP8200 CDRW\n");
- info->devicetype = USBAT_DEV_HP8200;
- }
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Set the transport function based on the device type
- */
- static int usbat_set_transport(struct us_data *us,
- struct usbat_info *info)
- {
- int rc;
- if (!info->devicetype) {
- rc = usbat_identify_device(us, info);
- if (rc != USB_STOR_TRANSPORT_GOOD) {
- US_DEBUGP("usbat_set_transport: Could not identify device\n");
- return 1;
- }
- }
- if (usbat_get_device_type(us) == USBAT_DEV_HP8200)
- us->transport = usbat_hp8200e_transport;
- else if (usbat_get_device_type(us) == USBAT_DEV_FLASH)
- us->transport = usbat_flash_transport;
- return 0;
- }
- /*
- * Read the media capacity
- */
- static int usbat_flash_get_sector_count(struct us_data *us,
- struct usbat_info *info)
- {
- unsigned char registers[3] = {
- USBAT_ATA_SECCNT,
- USBAT_ATA_DEVICE,
- USBAT_ATA_CMD,
- };
- unsigned char command[3] = { 0x01, 0xA0, 0xEC };
- unsigned char *reply;
- unsigned char status;
- int rc;
- if (!us || !info)
- return USB_STOR_TRANSPORT_ERROR;
- reply = kmalloc(512, GFP_NOIO);
- if (!reply)
- return USB_STOR_TRANSPORT_ERROR;
- // ATAPI command : IDENTIFY DEVICE
- rc = usbat_multiple_write(us, registers, command, 3);
- if (rc != USB_STOR_XFER_GOOD) {
- US_DEBUGP("usbat_flash_get_sector_count: Gah! identify_device failed\n");
- rc = USB_STOR_TRANSPORT_ERROR;
- goto leave;
- }
- // Read device status
- if (usbat_get_status(us, &status) != USB_STOR_XFER_GOOD) {
- rc = USB_STOR_TRANSPORT_ERROR;
- goto leave;
- }
- msleep(100);
- // Read the device identification data
- rc = usbat_read_block(us, reply, 512);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- goto leave;
- info->sectors = ((u32)(reply[117]) << 24) |
- ((u32)(reply[116]) << 16) |
- ((u32)(reply[115]) << 8) |
- ((u32)(reply[114]) );
- rc = USB_STOR_TRANSPORT_GOOD;
- leave:
- kfree(reply);
- return rc;
- }
- /*
- * Read data from device
- */
- static int usbat_flash_read_data(struct us_data *us,
- struct usbat_info *info,
- u32 sector,
- u32 sectors)
- {
- unsigned char registers[7] = {
- USBAT_ATA_FEATURES,
- USBAT_ATA_SECCNT,
- USBAT_ATA_SECNUM,
- USBAT_ATA_LBA_ME,
- USBAT_ATA_LBA_HI,
- USBAT_ATA_DEVICE,
- USBAT_ATA_STATUS,
- };
- unsigned char command[7];
- unsigned char *buffer;
- unsigned char thistime;
- unsigned int totallen, alloclen;
- int len, result;
- unsigned int sg_idx = 0, sg_offset = 0;
- result = usbat_flash_check_media(us, info);
- if (result != USB_STOR_TRANSPORT_GOOD)
- return result;
- // we're working in LBA mode. according to the ATA spec,
- // we can support up to 28-bit addressing. I don't know if Jumpshot
- // supports beyond 24-bit addressing. It's kind of hard to test
- // since it requires > 8GB CF card.
- if (sector > 0x0FFFFFFF)
- return USB_STOR_TRANSPORT_ERROR;
- totallen = sectors * info->ssize;
- // Since we don't read more than 64 KB at a time, we have to create
- // a bounce buffer and move the data a piece at a time between the
- // bounce buffer and the actual transfer buffer.
- alloclen = min(totallen, 65536u);
- buffer = kmalloc(alloclen, GFP_NOIO);
- if (buffer == NULL)
- return USB_STOR_TRANSPORT_ERROR;
- do {
- // loop, never allocate or transfer more than 64k at once
- // (min(128k, 255*info->ssize) is the real limit)
- len = min(totallen, alloclen);
- thistime = (len / info->ssize) & 0xff;
-
- // ATAPI command 0x20 (READ SECTORS)
- usbat_pack_atapi_sector_cmd(command, thistime, sector, 0x20);
- // Write/execute ATAPI read command
- result = usbat_multiple_write(us, registers, command, 7);
- if (result != USB_STOR_TRANSPORT_GOOD)
- goto leave;
- // Read the data we just requested
- result = usbat_read_blocks(us, buffer, len);
- if (result != USB_STOR_TRANSPORT_GOOD)
- goto leave;
-
- US_DEBUGP("usbat_flash_read_data: %d bytes\n", len);
-
- // Store the data in the transfer buffer
- usb_stor_access_xfer_buf(buffer, len, us->srb,
- &sg_idx, &sg_offset, TO_XFER_BUF);
- sector += thistime;
- totallen -= len;
- } while (totallen > 0);
- kfree(buffer);
- return USB_STOR_TRANSPORT_GOOD;
- leave:
- kfree(buffer);
- return USB_STOR_TRANSPORT_ERROR;
- }
- /*
- * Write data to device
- */
- static int usbat_flash_write_data(struct us_data *us,
- struct usbat_info *info,
- u32 sector,
- u32 sectors)
- {
- unsigned char registers[7] = {
- USBAT_ATA_FEATURES,
- USBAT_ATA_SECCNT,
- USBAT_ATA_SECNUM,
- USBAT_ATA_LBA_ME,
- USBAT_ATA_LBA_HI,
- USBAT_ATA_DEVICE,
- USBAT_ATA_STATUS,
- };
- unsigned char command[7];
- unsigned char *buffer;
- unsigned char thistime;
- unsigned int totallen, alloclen;
- int len, result;
- unsigned int sg_idx = 0, sg_offset = 0;
- result = usbat_flash_check_media(us, info);
- if (result != USB_STOR_TRANSPORT_GOOD)
- return result;
- // we're working in LBA mode. according to the ATA spec,
- // we can support up to 28-bit addressing. I don't know if Jumpshot
- // supports beyond 24-bit addressing. It's kind of hard to test
- // since it requires > 8GB CF card.
- if (sector > 0x0FFFFFFF)
- return USB_STOR_TRANSPORT_ERROR;
- totallen = sectors * info->ssize;
- // Since we don't write more than 64 KB at a time, we have to create
- // a bounce buffer and move the data a piece at a time between the
- // bounce buffer and the actual transfer buffer.
- alloclen = min(totallen, 65536u);
- buffer = kmalloc(alloclen, GFP_NOIO);
- if (buffer == NULL)
- return USB_STOR_TRANSPORT_ERROR;
- do {
- // loop, never allocate or transfer more than 64k at once
- // (min(128k, 255*info->ssize) is the real limit)
- len = min(totallen, alloclen);
- thistime = (len / info->ssize) & 0xff;
- // Get the data from the transfer buffer
- usb_stor_access_xfer_buf(buffer, len, us->srb,
- &sg_idx, &sg_offset, FROM_XFER_BUF);
- // ATAPI command 0x30 (WRITE SECTORS)
- usbat_pack_atapi_sector_cmd(command, thistime, sector, 0x30);
- // Write/execute ATAPI write command
- result = usbat_multiple_write(us, registers, command, 7);
- if (result != USB_STOR_TRANSPORT_GOOD)
- goto leave;
- // Write the data
- result = usbat_write_blocks(us, buffer, len);
- if (result != USB_STOR_TRANSPORT_GOOD)
- goto leave;
- sector += thistime;
- totallen -= len;
- } while (totallen > 0);
- kfree(buffer);
- return result;
- leave:
- kfree(buffer);
- return USB_STOR_TRANSPORT_ERROR;
- }
- /*
- * Squeeze a potentially huge (> 65535 byte) read10 command into
- * a little ( <= 65535 byte) ATAPI pipe
- */
- static int usbat_hp8200e_handle_read10(struct us_data *us,
- unsigned char *registers,
- unsigned char *data,
- struct scsi_cmnd *srb)
- {
- int result = USB_STOR_TRANSPORT_GOOD;
- unsigned char *buffer;
- unsigned int len;
- unsigned int sector;
- unsigned int sg_segment = 0;
- unsigned int sg_offset = 0;
- US_DEBUGP("handle_read10: transfersize %d\n",
- srb->transfersize);
- if (srb->request_bufflen < 0x10000) {
- result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
- registers, data, 19,
- USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
- (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
- DMA_FROM_DEVICE,
- srb->request_buffer,
- srb->request_bufflen, srb->use_sg, 1);
- return result;
- }
- /*
- * Since we're requesting more data than we can handle in
- * a single read command (max is 64k-1), we will perform
- * multiple reads, but each read must be in multiples of
- * a sector. Luckily the sector size is in srb->transfersize
- * (see linux/drivers/scsi/sr.c).
- */
- if (data[7+0] == GPCMD_READ_CD) {
- len = short_pack(data[7+9], data[7+8]);
- len <<= 16;
- len |= data[7+7];
- US_DEBUGP("handle_read10: GPCMD_READ_CD: len %d\n", len);
- srb->transfersize = srb->request_bufflen/len;
- }
- if (!srb->transfersize) {
- srb->transfersize = 2048; /* A guess */
- US_DEBUGP("handle_read10: transfersize 0, forcing %d\n",
- srb->transfersize);
- }
- // Since we only read in one block at a time, we have to create
- // a bounce buffer and move the data a piece at a time between the
- // bounce buffer and the actual transfer buffer.
- len = (65535/srb->transfersize) * srb->transfersize;
- US_DEBUGP("Max read is %d bytes\n", len);
- len = min(len, srb->request_bufflen);
- buffer = kmalloc(len, GFP_NOIO);
- if (buffer == NULL) // bloody hell!
- return USB_STOR_TRANSPORT_FAILED;
- sector = short_pack(data[7+3], data[7+2]);
- sector <<= 16;
- sector |= short_pack(data[7+5], data[7+4]);
- transferred = 0;
- sg_segment = 0; // for keeping track of where we are in
- sg_offset = 0; // the scatter/gather list
- while (transferred != srb->request_bufflen) {
- if (len > srb->request_bufflen - transferred)
- len = srb->request_bufflen - transferred;
- data[3] = len&0xFF; // (cylL) = expected length (L)
- data[4] = (len>>8)&0xFF; // (cylH) = expected length (H)
- // Fix up the SCSI command sector and num sectors
- data[7+2] = MSB_of(sector>>16); // SCSI command sector
- data[7+3] = LSB_of(sector>>16);
- data[7+4] = MSB_of(sector&0xFFFF);
- data[7+5] = LSB_of(sector&0xFFFF);
- if (data[7+0] == GPCMD_READ_CD)
- data[7+6] = 0;
- data[7+7] = MSB_of(len / srb->transfersize); // SCSI command
- data[7+8] = LSB_of(len / srb->transfersize); // num sectors
- result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
- registers, data, 19,
- USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
- (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
- DMA_FROM_DEVICE,
- buffer,
- len, 0, 1);
- if (result != USB_STOR_TRANSPORT_GOOD)
- break;
- // Store the data in the transfer buffer
- usb_stor_access_xfer_buf(buffer, len, srb,
- &sg_segment, &sg_offset, TO_XFER_BUF);
- // Update the amount transferred and the sector number
- transferred += len;
- sector += len / srb->transfersize;
- } // while transferred != srb->request_bufflen
- kfree(buffer);
- return result;
- }
- static int usbat_select_and_test_registers(struct us_data *us)
- {
- int selector;
- unsigned char *status = us->iobuf;
- // try device = master, then device = slave.
- for (selector = 0xA0; selector <= 0xB0; selector += 0x10) {
- if (usbat_write(us, USBAT_ATA, USBAT_ATA_DEVICE, selector) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_STATUS, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_DEVICE, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_HI, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_write(us, USBAT_ATA, USBAT_ATA_LBA_ME, 0x55) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_write(us, USBAT_ATA, USBAT_ATA_LBA_HI, 0xAA) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
- USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- }
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Initialize the USBAT processor and the storage device
- */
- int init_usbat(struct us_data *us)
- {
- int rc;
- struct usbat_info *info;
- unsigned char subcountH = USBAT_ATA_LBA_HI;
- unsigned char subcountL = USBAT_ATA_LBA_ME;
- unsigned char *status = us->iobuf;
- us->extra = kmalloc(sizeof(struct usbat_info), GFP_NOIO);
- if (!us->extra) {
- US_DEBUGP("init_usbat: Gah! Can't allocate storage for usbat info struct!\n");
- return 1;
- }
- memset(us->extra, 0, sizeof(struct usbat_info));
- info = (struct usbat_info *) (us->extra);
- // Enable peripheral control signals
- rc = usbat_write_user_io(us,
- USBAT_UIO_OE1 | USBAT_UIO_OE0,
- USBAT_UIO_EPAD | USBAT_UIO_1);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 1\n");
- msleep(2000);
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- US_DEBUGP("INIT 2\n");
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 3\n");
- rc = usbat_select_and_test_registers(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- US_DEBUGP("INIT 4\n");
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 5\n");
- // Enable peripheral control signals and card detect
- rc = usbat_device_enable_cdt(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- US_DEBUGP("INIT 6\n");
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 7\n");
- msleep(1400);
- rc = usbat_read_user_io(us, status);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 8\n");
- rc = usbat_select_and_test_registers(us);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- US_DEBUGP("INIT 9\n");
- // At this point, we need to detect which device we are using
- if (usbat_set_transport(us, info))
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 10\n");
- if (usbat_get_device_type(us) == USBAT_DEV_FLASH) {
- subcountH = 0x02;
- subcountL = 0x00;
- }
- rc = usbat_set_shuttle_features(us, (USBAT_FEAT_ETEN | USBAT_FEAT_ET2 | USBAT_FEAT_ET1),
- 0x00, 0x88, 0x08, subcountH, subcountL);
- if (rc != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- US_DEBUGP("INIT 11\n");
- return USB_STOR_TRANSPORT_GOOD;
- }
- /*
- * Transport for the HP 8200e
- */
- static int usbat_hp8200e_transport(struct scsi_cmnd *srb, struct us_data *us)
- {
- int result;
- unsigned char *status = us->iobuf;
- unsigned char registers[32];
- unsigned char data[32];
- unsigned int len;
- int i;
- char string[64];
- len = srb->request_bufflen;
- /* Send A0 (ATA PACKET COMMAND).
- Note: I guess we're never going to get any of the ATA
- commands... just ATA Packet Commands.
- */
- registers[0] = USBAT_ATA_FEATURES;
- registers[1] = USBAT_ATA_SECCNT;
- registers[2] = USBAT_ATA_SECNUM;
- registers[3] = USBAT_ATA_LBA_ME;
- registers[4] = USBAT_ATA_LBA_HI;
- registers[5] = USBAT_ATA_DEVICE;
- registers[6] = USBAT_ATA_CMD;
- data[0] = 0x00;
- data[1] = 0x00;
- data[2] = 0x00;
- data[3] = len&0xFF; // (cylL) = expected length (L)
- data[4] = (len>>8)&0xFF; // (cylH) = expected length (H)
- data[5] = 0xB0; // (device sel) = slave
- data[6] = 0xA0; // (command) = ATA PACKET COMMAND
- for (i=7; i<19; i++) {
- registers[i] = 0x10;
- data[i] = (i-7 >= srb->cmd_len) ? 0 : srb->cmnd[i-7];
- }
- result = usbat_get_status(us, status);
- US_DEBUGP("Status = %02X\n", *status);
- if (result != USB_STOR_XFER_GOOD)
- return USB_STOR_TRANSPORT_ERROR;
- if (srb->cmnd[0] == TEST_UNIT_READY)
- transferred = 0;
- if (srb->sc_data_direction == DMA_TO_DEVICE) {
- result = usbat_hp8200e_rw_block_test(us, USBAT_ATA,
- registers, data, 19,
- USBAT_ATA_DATA, USBAT_ATA_STATUS, 0xFD,
- (USBAT_QUAL_FCQ | USBAT_QUAL_ALQ),
- DMA_TO_DEVICE,
- srb->request_buffer,
- len, srb->use_sg, 10);
- if (result == USB_STOR_TRANSPORT_GOOD) {
- transferred += len;
- US_DEBUGP("Wrote %08X bytes\n", transferred);
- }
- return result;
- } else if (srb->cmnd[0] == READ_10 ||
- srb->cmnd[0] == GPCMD_READ_CD) {
- return usbat_hp8200e_handle_read10(us, registers, data, srb);
- }
- if (len > 0xFFFF) {
- US_DEBUGP("Error: len = %08X... what do I do now?\n",
- len);
- return USB_STOR_TRANSPORT_ERROR;
- }
- if ( (result = usbat_multiple_write(us,
- registers, data, 7)) != USB_STOR_TRANSPORT_GOOD) {
- return result;
- }
- // Write the 12-byte command header.
- // If the command is BLANK then set the timer for 75 minutes.
- // Otherwise set it for 10 minutes.
- // NOTE: THE 8200 DOCUMENTATION STATES THAT BLANKING A CDRW
- // AT SPEED 4 IS UNRELIABLE!!!
- if ( (result = usbat_write_block(us,
- USBAT_ATA, srb->cmnd, 12,
- srb->cmnd[0]==GPCMD_BLANK ? 75 : 10)) !=
- USB_STOR_TRANSPORT_GOOD) {
- return result;
- }
- // If there is response data to be read in
- // then do it here.
- if (len != 0 && (srb->sc_data_direction == DMA_FROM_DEVICE)) {
- // How many bytes to read in? Check cylL register
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_ME, status) !=
- USB_STOR_XFER_GOOD) {
- return USB_STOR_TRANSPORT_ERROR;
- }
- if (len > 0xFF) { // need to read cylH also
- len = *status;
- if (usbat_read(us, USBAT_ATA, USBAT_ATA_LBA_HI, status) !=
- USB_STOR_XFER_GOOD) {
- return USB_STOR_TRANSPORT_ERROR;
- }
- len += ((unsigned int) *status)<<8;
- }
- else
- len = *status;
- result = usbat_read_block(us, srb->request_buffer, len);
- /* Debug-print the first 32 bytes of the transfer */
- if (!srb->use_sg) {
- string[0] = 0;
- for (i=0; i<len && i<32; i++) {
- sprintf(string+strlen(string), "%02X ",
- ((unsigned char *)srb->request_buffer)[i]);
- if ((i%16)==15) {
- US_DEBUGP("%s\n", string);
- string[0] = 0;
- }
- }
- if (string[0]!=0)
- US_DEBUGP("%s\n", string);
- }
- }
- return result;
- }
- /*
- * Transport for USBAT02-based CompactFlash and similar storage devices
- */
- static int usbat_flash_transport(struct scsi_cmnd * srb, struct us_data *us)
- {
- int rc;
- struct usbat_info *info = (struct usbat_info *) (us->extra);
- unsigned long block, blocks;
- unsigned char *ptr = us->iobuf;
- static unsigned char inquiry_response[36] = {
- 0x00, 0x80, 0x00, 0x01, 0x1F, 0x00, 0x00, 0x00
- };
- if (srb->cmnd[0] == INQUIRY) {
- US_DEBUGP("usbat_flash_transport: INQUIRY. Returning bogus response.\n");
- memcpy(ptr, inquiry_response, sizeof(inquiry_response));
- fill_inquiry_response(us, ptr, 36);
- return USB_STOR_TRANSPORT_GOOD;
- }
- if (srb->cmnd[0] == READ_CAPACITY) {
- rc = usbat_flash_check_media(us, info);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- rc = usbat_flash_get_sector_count(us, info);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- info->ssize = 0x200; // hard coded 512 byte sectors as per ATA spec
- US_DEBUGP("usbat_flash_transport: READ_CAPACITY: %ld sectors, %ld bytes per sector\n",
- info->sectors, info->ssize);
- // build the reply
- // note: must return the sector number of the last sector,
- // *not* the total number of sectors
- ((__be32 *) ptr)[0] = cpu_to_be32(info->sectors - 1);
- ((__be32 *) ptr)[1] = cpu_to_be32(info->ssize);
- usb_stor_set_xfer_buf(ptr, 8, srb);
- return USB_STOR_TRANSPORT_GOOD;
- }
- if (srb->cmnd[0] == MODE_SELECT_10) {
- US_DEBUGP("usbat_flash_transport: Gah! MODE_SELECT_10.\n");
- return USB_STOR_TRANSPORT_ERROR;
- }
- if (srb->cmnd[0] == READ_10) {
- block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
- ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
- blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
- US_DEBUGP("usbat_flash_transport: READ_10: read block 0x%04lx count %ld\n", block, blocks);
- return usbat_flash_read_data(us, info, block, blocks);
- }
- if (srb->cmnd[0] == READ_12) {
- // I don't think we'll ever see a READ_12 but support it anyway...
- block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
- ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
- blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
- ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
- US_DEBUGP("usbat_flash_transport: READ_12: read block 0x%04lx count %ld\n", block, blocks);
- return usbat_flash_read_data(us, info, block, blocks);
- }
- if (srb->cmnd[0] == WRITE_10) {
- block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
- ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
- blocks = ((u32)(srb->cmnd[7]) << 8) | ((u32)(srb->cmnd[8]));
- US_DEBUGP("usbat_flash_transport: WRITE_10: write block 0x%04lx count %ld\n", block, blocks);
- return usbat_flash_write_data(us, info, block, blocks);
- }
- if (srb->cmnd[0] == WRITE_12) {
- // I don't think we'll ever see a WRITE_12 but support it anyway...
- block = ((u32)(srb->cmnd[2]) << 24) | ((u32)(srb->cmnd[3]) << 16) |
- ((u32)(srb->cmnd[4]) << 8) | ((u32)(srb->cmnd[5]));
- blocks = ((u32)(srb->cmnd[6]) << 24) | ((u32)(srb->cmnd[7]) << 16) |
- ((u32)(srb->cmnd[8]) << 8) | ((u32)(srb->cmnd[9]));
- US_DEBUGP("usbat_flash_transport: WRITE_12: write block 0x%04lx count %ld\n", block, blocks);
- return usbat_flash_write_data(us, info, block, blocks);
- }
- if (srb->cmnd[0] == TEST_UNIT_READY) {
- US_DEBUGP("usbat_flash_transport: TEST_UNIT_READY.\n");
- rc = usbat_flash_check_media(us, info);
- if (rc != USB_STOR_TRANSPORT_GOOD)
- return rc;
- return usbat_check_status(us);
- }
- if (srb->cmnd[0] == REQUEST_SENSE) {
- US_DEBUGP("usbat_flash_transport: REQUEST_SENSE.\n");
- memset(ptr, 0, 18);
- ptr[0] = 0xF0;
- ptr[2] = info->sense_key;
- ptr[7] = 11;
- ptr[12] = info->sense_asc;
- ptr[13] = info->sense_ascq;
- usb_stor_set_xfer_buf(ptr, 18, srb);
- return USB_STOR_TRANSPORT_GOOD;
- }
- if (srb->cmnd[0] == ALLOW_MEDIUM_REMOVAL) {
- // sure. whatever. not like we can stop the user from popping
- // the media out of the device (no locking doors, etc)
- return USB_STOR_TRANSPORT_GOOD;
- }
- US_DEBUGP("usbat_flash_transport: Gah! Unknown command: %d (0x%x)\n",
- srb->cmnd[0], srb->cmnd[0]);
- info->sense_key = 0x05;
- info->sense_asc = 0x20;
- info->sense_ascq = 0x00;
- return USB_STOR_TRANSPORT_FAILED;
- }
- /*
- * Default transport function. Attempts to detect which transport function
- * should be called, makes it the new default, and calls it.
- *
- * This function should never be called. Our usbat_init() function detects the
- * device type and changes the us->transport ptr to the transport function
- * relevant to the device.
- * However, we'll support this impossible(?) case anyway.
- */
- int usbat_transport(struct scsi_cmnd *srb, struct us_data *us)
- {
- struct usbat_info *info = (struct usbat_info*) (us->extra);
- if (usbat_set_transport(us, info))
- return USB_STOR_TRANSPORT_ERROR;
- return us->transport(srb, us);
- }
|