70 static int datafab_determine_lun(struct us_data *us,
114 datafab_bulk_read(struct us_data *us, unsigned char *data, unsigned int len) {  in datafab_bulk_read()  argument
115 	if (len == 0)  in datafab_bulk_read()
118 	usb_stor_dbg(us, "len = %d\n", len);  in datafab_bulk_read()
119 	return usb_stor_bulk_transfer_buf(us, us->recv_bulk_pipe,  in datafab_bulk_read()
125 datafab_bulk_write(struct us_data *us, unsigned char *data, unsigned int len) {  in datafab_bulk_write()  argument
126 	if (len == 0)  in datafab_bulk_write()
129 	usb_stor_dbg(us, "len = %d\n", len);  in datafab_bulk_write()
130 	return usb_stor_bulk_transfer_buf(us, us->send_bulk_pipe,  in datafab_bulk_write()
135 static int datafab_read_data(struct us_data *us,  in datafab_read_data()  argument
140 	unsigned char *command = us->iobuf;  in datafab_read_data()
145 	unsigned int sg_offset = 0;  in datafab_read_data()
153 	if (sectors > 0x0FFFFFFF)  in datafab_read_data()
157 		result = datafab_determine_lun(us, info);  in datafab_read_data()
178 		thistime = (len / info->ssize) & 0xff;  in datafab_read_data()
180 		command[0] = 0;  in datafab_read_data()
182 		command[2] = sector & 0xFF;  in datafab_read_data()
183 		command[3] = (sector >> 8) & 0xFF;  in datafab_read_data()
184 		command[4] = (sector >> 16) & 0xFF;  in datafab_read_data()
186 		command[5] = 0xE0 + (info->lun << 4);  in datafab_read_data()
187 		command[5] |= (sector >> 24) & 0x0F;  in datafab_read_data()
188 		command[6] = 0x20;  in datafab_read_data()
189 		command[7] = 0x01;  in datafab_read_data()
192 		result = datafab_bulk_write(us, command, 8);  in datafab_read_data()
197 		result = datafab_bulk_read(us, buffer, len);  in datafab_read_data()
202 		usb_stor_access_xfer_buf(buffer, len, us->srb,  in datafab_read_data()
207 	} while (totallen > 0);  in datafab_read_data()
218 static int datafab_write_data(struct us_data *us,  in datafab_write_data()  argument
223 	unsigned char *command = us->iobuf;  in datafab_write_data()
224 	unsigned char *reply = us->iobuf;  in datafab_write_data()
229 	unsigned int sg_offset = 0;  in datafab_write_data()
237 	if (sectors > 0x0FFFFFFF)  in datafab_write_data()
241 		result = datafab_determine_lun(us, info);  in datafab_write_data()
262 		thistime = (len / info->ssize) & 0xff;  in datafab_write_data()
265 		usb_stor_access_xfer_buf(buffer, len, us->srb,  in datafab_write_data()
268 		command[0] = 0;  in datafab_write_data()
270 		command[2] = sector & 0xFF;  in datafab_write_data()
271 		command[3] = (sector >> 8) & 0xFF;  in datafab_write_data()
272 		command[4] = (sector >> 16) & 0xFF;  in datafab_write_data()
274 		command[5] = 0xE0 + (info->lun << 4);  in datafab_write_data()
275 		command[5] |= (sector >> 24) & 0x0F;  in datafab_write_data()
276 		command[6] = 0x30;  in datafab_write_data()
277 		command[7] = 0x02;  in datafab_write_data()
280 		result = datafab_bulk_write(us, command, 8);  in datafab_write_data()
285 		result = datafab_bulk_write(us, buffer, len);  in datafab_write_data()
290 		result = datafab_bulk_read(us, reply, 2);  in datafab_write_data()
294 		if (reply[0] != 0x50 && reply[1] != 0) {  in datafab_write_data()
295 			usb_stor_dbg(us, "Gah! write return code: %02x %02x\n",  in datafab_write_data()
296 				     reply[0], reply[1]);  in datafab_write_data()
303 	} while (totallen > 0);  in datafab_write_data()
314 static int datafab_determine_lun(struct us_data *us,  in datafab_determine_lun()  argument
323 	static unsigned char scommand[8] = { 0, 1, 0, 0, 0, 0xa0, 0xec, 1 };  in datafab_determine_lun()
324 	unsigned char *command = us->iobuf;  in datafab_determine_lun()
326 	int count = 0, rc;  in datafab_determine_lun()
336 	usb_stor_dbg(us, "locating...\n");  in datafab_determine_lun()
341 		command[5] = 0xa0;  in datafab_determine_lun()
343 		rc = datafab_bulk_write(us, command, 8);  in datafab_determine_lun()
349 		rc = datafab_bulk_read(us, buf, 512);  in datafab_determine_lun()
351 			info->lun = 0;  in datafab_determine_lun()
356 		command[5] = 0xb0;  in datafab_determine_lun()
358 		rc = datafab_bulk_write(us, command, 8);  in datafab_determine_lun()
364 		rc = datafab_bulk_read(us, buf, 512);  in datafab_determine_lun()
381 static int datafab_id_device(struct us_data *us,  in datafab_id_device()  argument
388 	static unsigned char scommand[8] = { 0, 1, 0, 0, 0, 0xa0, 0xec, 1 };  in datafab_id_device()
389 	unsigned char *command = us->iobuf;  in datafab_id_device()
397 		rc = datafab_determine_lun(us, info);  in datafab_id_device()
409 	rc = datafab_bulk_write(us, command, 8);  in datafab_id_device()
417 	rc = datafab_bulk_read(us, reply, 512);  in datafab_id_device()
437 static int datafab_handle_mode_sense(struct us_data *us,  in datafab_handle_mode_sense()  argument
442 		0x1, 0xA, 0x21, 1, 0, 0, 0, 0, 1, 0, 0, 0  in datafab_handle_mode_sense()
445 		0x8, 0xA, 0x1, 0, 0, 0, 0, 0, 0, 0, 0, 0  in datafab_handle_mode_sense()
448 		0x1B, 0xA, 0, 0x81, 0, 0, 0, 0, 0, 0, 0, 0  in datafab_handle_mode_sense()
451 		0x1C, 0x6, 0, 0, 0, 0  in datafab_handle_mode_sense()
454 	unsigned int i = 0;  in datafab_handle_mode_sense()
455 	struct datafab_info *info = (struct datafab_info *) (us->extra);  in datafab_handle_mode_sense()
456 	unsigned char *ptr = us->iobuf;  in datafab_handle_mode_sense()
464 	page_code = srb->cmnd[2] & 0x3F;  in datafab_handle_mode_sense()
467 	   case 0x0:  in datafab_handle_mode_sense()
468 		   usb_stor_dbg(us, "Current values\n");  in datafab_handle_mode_sense()
470 	   case 0x1:  in datafab_handle_mode_sense()
471 		   usb_stor_dbg(us, "Changeable values\n");  in datafab_handle_mode_sense()
473 	   case 0x2:  in datafab_handle_mode_sense()
474 		   usb_stor_dbg(us, "Default values\n");  in datafab_handle_mode_sense()
476 	   case 0x3:  in datafab_handle_mode_sense()
477 		   usb_stor_dbg(us, "Saves values\n");  in datafab_handle_mode_sense()
481 	memset(ptr, 0, 8);  in datafab_handle_mode_sense()
483 		ptr[2] = 0x00;		// WP enable: 0x80  in datafab_handle_mode_sense()
486 		ptr[3] = 0x00;		// WP enable: 0x80  in datafab_handle_mode_sense()
493 		info->sense_key = 0x05;  in datafab_handle_mode_sense()
494 		info->sense_asc = 0x24;  in datafab_handle_mode_sense()
495 		info->sense_ascq = 0x00;  in datafab_handle_mode_sense()
498 	   case 0x1:  in datafab_handle_mode_sense()
503 	   case 0x8:  in datafab_handle_mode_sense()
508 	   case 0x1B:  in datafab_handle_mode_sense()
513 	   case 0x1C:  in datafab_handle_mode_sense()
518 	   case 0x3F:		// retrieve all pages  in datafab_handle_mode_sense()
531 		ptr[0] = i - 1;  in datafab_handle_mode_sense()
533 		((__be16 *) ptr)[0] = cpu_to_be16(i - 2);  in datafab_handle_mode_sense()
548 static int datafab_transport(struct scsi_cmnd *srb, struct us_data *us)  in datafab_transport()  argument
553 	unsigned char *ptr = us->iobuf;  in datafab_transport()
555 		0x00, 0x80, 0x00, 0x01, 0x1F, 0x00, 0x00, 0x00  in datafab_transport()
558 	if (!us->extra) {  in datafab_transport()
559 		us->extra = kzalloc(sizeof(struct datafab_info), GFP_NOIO);  in datafab_transport()
560 		if (!us->extra)  in datafab_transport()
563 		us->extra_destructor = datafab_info_destructor;  in datafab_transport()
564   		((struct datafab_info *)us->extra)->lun = -1;  in datafab_transport()
567 	info = (struct datafab_info *) (us->extra);  in datafab_transport()
569 	if (srb->cmnd[0] == INQUIRY) {  in datafab_transport()
570 		usb_stor_dbg(us, "INQUIRY - Returning bogus response\n");  in datafab_transport()
572 		fill_inquiry_response(us, ptr, 36);  in datafab_transport()
576 	if (srb->cmnd[0] == READ_CAPACITY) {  in datafab_transport()
577 		info->ssize = 0x200;  // hard coded 512 byte sectors as per ATA spec  in datafab_transport()
578 		rc = datafab_id_device(us, info);  in datafab_transport()
582 		usb_stor_dbg(us, "READ_CAPACITY:  %ld sectors, %ld bytes per sector\n",  in datafab_transport()
587 		((__be32 *) ptr)[0] = cpu_to_be32(info->sectors - 1);  in datafab_transport()
594 	if (srb->cmnd[0] == MODE_SELECT_10) {  in datafab_transport()
595 		usb_stor_dbg(us, "Gah! MODE_SELECT_10\n");  in datafab_transport()
601 	if (srb->cmnd[0] == READ_10) {  in datafab_transport()
607 		usb_stor_dbg(us, "READ_10: read block 0x%04lx  count %ld\n",  in datafab_transport()
609 		return datafab_read_data(us, info, block, blocks);  in datafab_transport()
612 	if (srb->cmnd[0] == READ_12) {  in datafab_transport()
621 		usb_stor_dbg(us, "READ_12: read block 0x%04lx  count %ld\n",  in datafab_transport()
623 		return datafab_read_data(us, info, block, blocks);  in datafab_transport()
626 	if (srb->cmnd[0] == WRITE_10) {  in datafab_transport()
632 		usb_stor_dbg(us, "WRITE_10: write block 0x%04lx count %ld\n",  in datafab_transport()
634 		return datafab_write_data(us, info, block, blocks);  in datafab_transport()
637 	if (srb->cmnd[0] == WRITE_12) {  in datafab_transport()
646 		usb_stor_dbg(us, "WRITE_12: write block 0x%04lx count %ld\n",  in datafab_transport()
648 		return datafab_write_data(us, info, block, blocks);  in datafab_transport()
651 	if (srb->cmnd[0] == TEST_UNIT_READY) {  in datafab_transport()
652 		usb_stor_dbg(us, "TEST_UNIT_READY\n");  in datafab_transport()
653 		return datafab_id_device(us, info);  in datafab_transport()
656 	if (srb->cmnd[0] == REQUEST_SENSE) {  in datafab_transport()
657 		usb_stor_dbg(us, "REQUEST_SENSE - Returning faked response\n");  in datafab_transport()
663 		memset(ptr, 0, 18);  in datafab_transport()
664 		ptr[0] = 0xF0;  in datafab_transport()
674 	if (srb->cmnd[0] == MODE_SENSE) {  in datafab_transport()
675 		usb_stor_dbg(us, "MODE_SENSE_6 detected\n");  in datafab_transport()
676 		return datafab_handle_mode_sense(us, srb, 1);  in datafab_transport()
679 	if (srb->cmnd[0] == MODE_SENSE_10) {  in datafab_transport()
680 		usb_stor_dbg(us, "MODE_SENSE_10 detected\n");  in datafab_transport()
681 		return datafab_handle_mode_sense(us, srb, 0);  in datafab_transport()
684 	if (srb->cmnd[0] == ALLOW_MEDIUM_REMOVAL) {  in datafab_transport()
692 	if (srb->cmnd[0] == START_STOP) {  in datafab_transport()
697 		usb_stor_dbg(us, "START_STOP\n");  in datafab_transport()
702 		rc = datafab_id_device(us, info);  in datafab_transport()
713 	usb_stor_dbg(us, "Gah! Unknown command: %d (0x%x)\n",  in datafab_transport()
714 		     srb->cmnd[0], srb->cmnd[0]);  in datafab_transport()
715 	info->sense_key = 0x05;  in datafab_transport()
716 	info->sense_asc = 0x20;  in datafab_transport()
717 	info->sense_ascq = 0x00;  in datafab_transport()
726 	struct us_data *us;  in datafab_probe()  local
729 	result = usb_stor_probe1(&us, intf, id,  in datafab_probe()
735 	us->transport_name  = "Datafab Bulk-Only";  in datafab_probe()
736 	us->transport = datafab_transport;  in datafab_probe()
737 	us->transport_reset = usb_stor_Bulk_reset;  in datafab_probe()
738 	us->max_lun = 1;  in datafab_probe()
740 	result = usb_stor_probe2(us);  in datafab_probe()