1 #include <linux/sched.h>
2 #include <linux/errno.h>
3 #include <linux/slab.h>
6 #include <scsi/scsi_eh.h>
7 #include <scsi/scsi_device.h>
11 #include "transport.h"
14 int SM_SCSI_Test_Unit_Ready(struct us_data *us, struct scsi_cmnd *srb);
15 int SM_SCSI_Inquiry(struct us_data *us, struct scsi_cmnd *srb);
16 int SM_SCSI_Mode_Sense(struct us_data *us, struct scsi_cmnd *srb);
17 int SM_SCSI_Start_Stop(struct us_data *us, struct scsi_cmnd *srb);
18 int SM_SCSI_Read_Capacity(struct us_data *us, struct scsi_cmnd *srb);
19 int SM_SCSI_Read(struct us_data *us, struct scsi_cmnd *srb);
20 int SM_SCSI_Write(struct us_data *us, struct scsi_cmnd *srb);
22 extern PBYTE SMHostAddr;
23 extern DWORD ErrXDCode;
25 /* ----- SM_SCSIIrp() -------------------------------------------------- */
26 int SM_SCSIIrp(struct us_data *us, struct scsi_cmnd *srb)
30 us->SrbStatus = SS_SUCCESS;
31 switch (srb->cmnd[0]) {
33 result = SM_SCSI_Test_Unit_Ready(us, srb);
36 result = SM_SCSI_Inquiry(us, srb);
39 result = SM_SCSI_Mode_Sense(us, srb);
42 result = SM_SCSI_Read_Capacity(us, srb);
45 result = SM_SCSI_Read(us, srb);
48 result = SM_SCSI_Write(us, srb);
52 us->SrbStatus = SS_ILLEGAL_REQUEST;
53 result = USB_STOR_TRANSPORT_FAILED;
59 /* ----- SM_SCSI_Test_Unit_Ready() ------------------------------------- */
60 int SM_SCSI_Test_Unit_Ready(struct us_data *us, struct scsi_cmnd *srb)
62 if (us->SM_Status.Insert && us->SM_Status.Ready)
63 return USB_STOR_TRANSPORT_GOOD;
66 return USB_STOR_TRANSPORT_GOOD;
69 return USB_STOR_TRANSPORT_GOOD;
72 /* ----- SM_SCSI_Inquiry() --------------------------------------------- */
73 int SM_SCSI_Inquiry(struct us_data *us, struct scsi_cmnd *srb)
75 BYTE data_ptr[36] = {0x00, 0x80, 0x02, 0x00, 0x1F, 0x00, 0x00, 0x00,
76 0x55, 0x53, 0x42, 0x32, 0x2E, 0x30, 0x20,
77 0x20, 0x43, 0x61, 0x72, 0x64, 0x52, 0x65,
78 0x61, 0x64, 0x65, 0x72, 0x20, 0x20, 0x20,
79 0x20, 0x20, 0x20, 0x30, 0x31, 0x30, 0x30};
81 usb_stor_set_xfer_buf(us, data_ptr, 36, srb, TO_XFER_BUF);
82 return USB_STOR_TRANSPORT_GOOD;
86 /* ----- SM_SCSI_Mode_Sense() ------------------------------------------ */
87 int SM_SCSI_Mode_Sense(struct us_data *us, struct scsi_cmnd *srb)
89 BYTE mediaNoWP[12] = {0x0b, 0x00, 0x00, 0x08, 0x00, 0x00,
90 0x71, 0xc0, 0x00, 0x00, 0x02, 0x00};
91 BYTE mediaWP[12] = {0x0b, 0x00, 0x80, 0x08, 0x00, 0x00,
92 0x71, 0xc0, 0x00, 0x00, 0x02, 0x00};
94 if (us->SM_Status.WtP)
95 usb_stor_set_xfer_buf(us, mediaWP, 12, srb, TO_XFER_BUF);
97 usb_stor_set_xfer_buf(us, mediaNoWP, 12, srb, TO_XFER_BUF);
100 return USB_STOR_TRANSPORT_GOOD;
103 /* ----- SM_SCSI_Read_Capacity() --------------------------------------- */
104 int SM_SCSI_Read_Capacity(struct us_data *us, struct scsi_cmnd *srb)
106 unsigned int offset = 0;
107 struct scatterlist *sg = NULL;
112 dev_dbg(&us->pusb_dev->dev, "SM_SCSI_Read_Capacity\n");
115 bl_num = Ssfdc.MaxLogBlocks * Ssfdc.MaxSectors * Ssfdc.MaxZones - 1;
118 dev_dbg(&us->pusb_dev->dev, "bl_len = %x\n", bl_len);
119 dev_dbg(&us->pusb_dev->dev, "bl_num = %x\n", bl_num);
121 buf[0] = (bl_num >> 24) & 0xff;
122 buf[1] = (bl_num >> 16) & 0xff;
123 buf[2] = (bl_num >> 8) & 0xff;
124 buf[3] = (bl_num >> 0) & 0xff;
125 buf[4] = (bl_len >> 24) & 0xff;
126 buf[5] = (bl_len >> 16) & 0xff;
127 buf[6] = (bl_len >> 8) & 0xff;
128 buf[7] = (bl_len >> 0) & 0xff;
130 usb_stor_access_xfer_buf(us, buf, 8, srb, &sg, &offset, TO_XFER_BUF);
132 return USB_STOR_TRANSPORT_GOOD;
135 /* ----- SM_SCSI_Read() -------------------------------------------------- */
136 int SM_SCSI_Read(struct us_data *us, struct scsi_cmnd *srb)
139 PBYTE Cdb = srb->cmnd;
140 DWORD bn = ((Cdb[2] << 24) & 0xff000000) |
141 ((Cdb[3] << 16) & 0x00ff0000) |
142 ((Cdb[4] << 8) & 0x0000ff00) |
143 ((Cdb[5] << 0) & 0x000000ff);
144 WORD blen = ((Cdb[7] << 8) & 0xff00) | ((Cdb[8] << 0) & 0x00ff);
145 DWORD blenByte = blen * 0x200;
150 return USB_STOR_TRANSPORT_ERROR;
152 buf = kmalloc(blenByte, GFP_KERNEL);
154 return USB_STOR_TRANSPORT_ERROR;
155 result = Media_D_ReadSector(us, bn, blen, buf);
156 usb_stor_set_xfer_buf(us, buf, blenByte, srb, TO_XFER_BUF);
160 return USB_STOR_TRANSPORT_GOOD;
162 return USB_STOR_TRANSPORT_ERROR;
164 return USB_STOR_TRANSPORT_GOOD;
167 /* ----- SM_SCSI_Write() -------------------------------------------------- */
168 int SM_SCSI_Write(struct us_data *us, struct scsi_cmnd *srb)
171 PBYTE Cdb = srb->cmnd;
172 DWORD bn = ((Cdb[2] << 24) & 0xff000000) |
173 ((Cdb[3] << 16) & 0x00ff0000) |
174 ((Cdb[4] << 8) & 0x0000ff00) |
175 ((Cdb[5] << 0) & 0x000000ff);
176 WORD blen = ((Cdb[7] << 8) & 0xff00) | ((Cdb[8] << 0) & 0x00ff);
177 DWORD blenByte = blen * 0x200;
182 return USB_STOR_TRANSPORT_ERROR;
184 buf = kmalloc(blenByte, GFP_KERNEL);
186 return USB_STOR_TRANSPORT_ERROR;
187 usb_stor_set_xfer_buf(us, buf, blenByte, srb, FROM_XFER_BUF);
188 result = Media_D_CopySector(us, bn, blen, buf);
192 return USB_STOR_TRANSPORT_GOOD;
194 return USB_STOR_TRANSPORT_ERROR;
196 return USB_STOR_TRANSPORT_GOOD;