Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
smscsi.c
Go to the documentation of this file.
1 #include <linux/sched.h>
2 #include <linux/errno.h>
3 #include <linux/slab.h>
4 
5 #include <scsi/scsi.h>
6 #include <scsi/scsi_eh.h>
7 #include <scsi/scsi_device.h>
8 
9 #include "usb.h"
10 #include "scsiglue.h"
11 #include "transport.h"
12 #include "smil.h"
13 
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);
21 
22 extern PBYTE SMHostAddr;
23 extern DWORD ErrXDCode;
24 
25 /* ----- SM_SCSIIrp() -------------------------------------------------- */
26 int SM_SCSIIrp(struct us_data *us, struct scsi_cmnd *srb)
27 {
28  int result;
29 
30  us->SrbStatus = SS_SUCCESS;
31  switch (srb->cmnd[0]) {
32  case TEST_UNIT_READY:
33  result = SM_SCSI_Test_Unit_Ready(us, srb);
34  break; /* 0x00 */
35  case INQUIRY:
36  result = SM_SCSI_Inquiry(us, srb);
37  break; /* 0x12 */
38  case MODE_SENSE:
39  result = SM_SCSI_Mode_Sense(us, srb);
40  break; /* 0x1A */
41  case READ_CAPACITY:
42  result = SM_SCSI_Read_Capacity(us, srb);
43  break; /* 0x25 */
44  case READ_10:
45  result = SM_SCSI_Read(us, srb);
46  break; /* 0x28 */
47  case WRITE_10:
48  result = SM_SCSI_Write(us, srb);
49  break; /* 0x2A */
50 
51  default:
52  us->SrbStatus = SS_ILLEGAL_REQUEST;
53  result = USB_STOR_TRANSPORT_FAILED;
54  break;
55  }
56  return result;
57 }
58 
59 /* ----- SM_SCSI_Test_Unit_Ready() -------------------------------------------------- */
60 int SM_SCSI_Test_Unit_Ready(struct us_data *us, struct scsi_cmnd *srb)
61 {
62  if (us->SM_Status.Insert && us->SM_Status.Ready)
63  return USB_STOR_TRANSPORT_GOOD;
64  else {
65  ENE_SMInit(us);
66  return USB_STOR_TRANSPORT_GOOD;
67  }
68 
69  return USB_STOR_TRANSPORT_GOOD;
70 }
71 
72 /* ----- SM_SCSI_Inquiry() -------------------------------------------------- */
73 int SM_SCSI_Inquiry(struct us_data *us, struct scsi_cmnd *srb)
74 {
75  BYTE data_ptr[36] = {0x00, 0x80, 0x02, 0x00, 0x1F, 0x00, 0x00, 0x00, 0x55, 0x53, 0x42, 0x32, 0x2E, 0x30, 0x20, 0x20, 0x43, 0x61, 0x72, 0x64, 0x52, 0x65, 0x61, 0x64, 0x65, 0x72, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x30, 0x31, 0x30, 0x30};
76 
77  usb_stor_set_xfer_buf(us, data_ptr, 36, srb, TO_XFER_BUF);
78  return USB_STOR_TRANSPORT_GOOD;
79 }
80 
81 
82 /* ----- SM_SCSI_Mode_Sense() -------------------------------------------------- */
83 int SM_SCSI_Mode_Sense(struct us_data *us, struct scsi_cmnd *srb)
84 {
85  BYTE mediaNoWP[12] = {0x0b, 0x00, 0x00, 0x08, 0x00, 0x00, 0x71, 0xc0, 0x00, 0x00, 0x02, 0x00};
86  BYTE mediaWP[12] = {0x0b, 0x00, 0x80, 0x08, 0x00, 0x00, 0x71, 0xc0, 0x00, 0x00, 0x02, 0x00};
87 
88  if (us->SM_Status.WtP)
89  usb_stor_set_xfer_buf(us, mediaWP, 12, srb, TO_XFER_BUF);
90  else
91  usb_stor_set_xfer_buf(us, mediaNoWP, 12, srb, TO_XFER_BUF);
92 
93 
94  return USB_STOR_TRANSPORT_GOOD;
95 }
96 
97 /* ----- SM_SCSI_Read_Capacity() -------------------------------------------------- */
98 int SM_SCSI_Read_Capacity(struct us_data *us, struct scsi_cmnd *srb)
99 {
100  unsigned int offset = 0;
101  struct scatterlist *sg = NULL;
102  DWORD bl_num;
103  WORD bl_len;
104  BYTE buf[8];
105 
106  printk("SM_SCSI_Read_Capacity\n");
107 
108  bl_len = 0x200;
109  bl_num = Ssfdc.MaxLogBlocks * Ssfdc.MaxSectors * Ssfdc.MaxZones - 1;
110 
111  us->bl_num = bl_num;
112  printk("bl_len = %x\n", bl_len);
113  printk("bl_num = %x\n", bl_num);
114 
115  buf[0] = (bl_num >> 24) & 0xff;
116  buf[1] = (bl_num >> 16) & 0xff;
117  buf[2] = (bl_num >> 8) & 0xff;
118  buf[3] = (bl_num >> 0) & 0xff;
119  buf[4] = (bl_len >> 24) & 0xff;
120  buf[5] = (bl_len >> 16) & 0xff;
121  buf[6] = (bl_len >> 8) & 0xff;
122  buf[7] = (bl_len >> 0) & 0xff;
123 
124  usb_stor_access_xfer_buf(us, buf, 8, srb, &sg, &offset, TO_XFER_BUF);
125 
126  return USB_STOR_TRANSPORT_GOOD;
127 }
128 
129 /* ----- SM_SCSI_Read() -------------------------------------------------- */
130 int SM_SCSI_Read(struct us_data *us, struct scsi_cmnd *srb)
131 {
132  int result = 0;
133  PBYTE Cdb = srb->cmnd;
134  DWORD bn = ((Cdb[2] << 24) & 0xff000000) | ((Cdb[3] << 16) & 0x00ff0000) |
135  ((Cdb[4] << 8) & 0x0000ff00) | ((Cdb[5] << 0) & 0x000000ff);
136  WORD blen = ((Cdb[7] << 8) & 0xff00) | ((Cdb[8] << 0) & 0x00ff);
137  DWORD blenByte = blen * 0x200;
138  void *buf;
139 
140 
141  if (bn > us->bl_num)
142  return USB_STOR_TRANSPORT_ERROR;
143 
144  buf = kmalloc(blenByte, GFP_KERNEL);
145  if (buf == NULL)
146  return USB_STOR_TRANSPORT_ERROR;
147  result = Media_D_ReadSector(us, bn, blen, buf);
148  usb_stor_set_xfer_buf(us, buf, blenByte, srb, TO_XFER_BUF);
149  kfree(buf);
150 
151  if (!result)
152  return USB_STOR_TRANSPORT_GOOD;
153  else
154  return USB_STOR_TRANSPORT_ERROR;
155 
156  return USB_STOR_TRANSPORT_GOOD;
157 }
158 
159 /* ----- SM_SCSI_Write() -------------------------------------------------- */
160 int SM_SCSI_Write(struct us_data *us, struct scsi_cmnd *srb)
161 {
162  int result = 0;
163  PBYTE Cdb = srb->cmnd;
164  DWORD bn = ((Cdb[2] << 24) & 0xff000000) | ((Cdb[3] << 16) & 0x00ff0000) |
165  ((Cdb[4] << 8) & 0x0000ff00) | ((Cdb[5] << 0) & 0x000000ff);
166  WORD blen = ((Cdb[7] << 8) & 0xff00) | ((Cdb[8] << 0) & 0x00ff);
167  DWORD blenByte = blen * 0x200;
168  void *buf;
169 
170 
171  if (bn > us->bl_num)
172  return USB_STOR_TRANSPORT_ERROR;
173 
174  buf = kmalloc(blenByte, GFP_KERNEL);
175  if (buf == NULL)
176  return USB_STOR_TRANSPORT_ERROR;
177  usb_stor_set_xfer_buf(us, buf, blenByte, srb, FROM_XFER_BUF);
178  result = Media_D_CopySector(us, bn, blen, buf);
179  kfree(buf);
180 
181  if (!result)
182  return USB_STOR_TRANSPORT_GOOD;
183  else
184  return USB_STOR_TRANSPORT_ERROR;
185 
186  return USB_STOR_TRANSPORT_GOOD;
187 }
188 
Generated on Thu Jan 10 2013 14:29:02 for Linux Kernel by   doxygen 1.8.2