1 //<MStar Software>
2 //******************************************************************************
3 // MStar Software
4 // Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
5 // All software, firmware and related documentation herein ("MStar Software") are
6 // intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
7 // law, including, but not limited to, copyright law and international treaties.
8 // Any use, modification, reproduction, retransmission, or republication of all
9 // or part of MStar Software is expressly prohibited, unless prior written
10 // permission has been granted by MStar.
11 //
12 // By accessing, browsing and/or using MStar Software, you acknowledge that you
13 // have read, understood, and agree, to be bound by below terms ("Terms") and to
14 // comply with all applicable laws and regulations:
15 //
16 // 1. MStar shall retain any and all right, ownership and interest to MStar
17 // Software and any modification/derivatives thereof.
18 // No right, ownership, or interest to MStar Software and any
19 // modification/derivatives thereof is transferred to you under Terms.
20 //
21 // 2. You understand that MStar Software might include, incorporate or be
22 // supplied together with third party`s software and the use of MStar
23 // Software may require additional licenses from third parties.
24 // Therefore, you hereby agree it is your sole responsibility to separately
25 // obtain any and all third party right and license necessary for your use of
26 // such third party`s software.
27 //
28 // 3. MStar Software and any modification/derivatives thereof shall be deemed as
29 // MStar`s confidential information and you agree to keep MStar`s
30 // confidential information in strictest confidence and not disclose to any
31 // third party.
32 //
33 // 4. MStar Software is provided on an "AS IS" basis without warranties of any
34 // kind. Any warranties are hereby expressly disclaimed by MStar, including
35 // without limitation, any warranties of merchantability, non-infringement of
36 // intellectual property rights, fitness for a particular purpose, error free
37 // and in conformity with any international standard. You agree to waive any
38 // claim against MStar for any loss, damage, cost or expense that you may
39 // incur related to your use of MStar Software.
40 // In no event shall MStar be liable for any direct, indirect, incidental or
41 // consequential damages, including without limitation, lost of profit or
42 // revenues, lost or damage of data, and unauthorized system use.
43 // You agree that this Section 4 shall still apply without being affected
44 // even if MStar Software has been modified by MStar in accordance with your
45 // request or instruction for your use, except otherwise agreed by both
46 // parties in writing.
47 //
48 // 5. If requested, MStar may from time to time provide technical supports or
49 // services in relation with MStar Software to you for your use of
50 // MStar Software in conjunction with your or your customer`s product
51 // ("Services").
52 // You understand and agree that, except otherwise agreed by both parties in
53 // writing, Services are provided on an "AS IS" basis and the warranty
54 // disclaimer set forth in Section 4 above shall apply.
55 //
56 // 6. Nothing contained herein shall be construed as by implication, estoppels
57 // or otherwise:
58 // (a) conferring any license or right to use MStar name, trademark, service
59 // mark, symbol or any other identification;
60 // (b) obligating MStar or any of its affiliates to furnish any person,
61 // including without limitation, you and your customers, any assistance
62 // of any kind whatsoever, or any information; or
63 // (c) conferring any license or right under any intellectual property right.
64 //
65 // 7. These terms shall be governed by and construed in accordance with the laws
66 // of Taiwan, R.O.C., excluding its conflict of law rules.
67 // Any and all dispute arising out hereof or related hereto shall be finally
68 // settled by arbitration referred to the Chinese Arbitration Association,
69 // Taipei in accordance with the ROC Arbitration Law and the Arbitration
70 // Rules of the Association by three (3) arbitrators appointed in accordance
71 // with the said Rules.
72 // The place of arbitration shall be in Taipei, Taiwan and the language shall
73 // be English.
74 // The arbitration award shall be final and binding to both parties.
75 //
76 //******************************************************************************
77 //<MStar Software>
78
79 #include <MsCommon.h>
80 #include "drvProtocol.h"
81 #include "drvMassStor.h"
82 //#include "debug.h"
83 #include "drvTransport.h"
84 #if 1
85
86 #ifdef US_DEBUG
87 #define US_DEBUGP(x,...) printk(x,__VA_ARGS__)
88 #else
89 #define US_DEBUGP(x,...)
90 #endif
91
92 static void *
find_data_location(Scsi_Cmnd * srb)93 find_data_location(Scsi_Cmnd *srb)
94 {
95 if (srb->use_sg)
96 {
97 printk("find_data_location : unsupport scatter function.");
98 return (void *) srb->request_buffer;
99 }
100 else
101 return (void *) srb->request_buffer;
102 }
103
fix_inquiry_data(Scsi_Cmnd * srb)104 static void fix_inquiry_data(Scsi_Cmnd *srb)
105 {
106 unsigned char *data_ptr;
107
108 if (srb->cmnd[0] != INQUIRY)
109 return;
110
111 if (srb->request_bufflen < 3)
112 return;
113
114 data_ptr = (unsigned char*) find_data_location(srb);
115
116 if ((data_ptr[2] & 7) == 2)
117 return;
118
119 US_DEBUGP("Fixing INQUIRY data to show SCSI rev 2 - was %d\n",
120 data_ptr[2] & 7);
121
122 data_ptr[2] = (data_ptr[2] & ~7) | 2;
123 }
124
fix_read_capacity(Scsi_Cmnd * srb)125 static void fix_read_capacity(Scsi_Cmnd *srb)
126 {
127 unsigned char *dp;
128 U32 capacity;
129
130 if (srb->cmnd[0] != READ_CAPACITY)
131 return;
132
133 dp = (unsigned char*) find_data_location(srb);
134
135 capacity = (dp[0]<<24) + (dp[1]<<16) + (dp[2]<<8) + (dp[3]);
136 US_DEBUGP("US: Fixing capacity: from %ld to %ld\n",
137 capacity+1, capacity);
138 capacity--;
139 dp[0] = (capacity >> 24);
140 dp[1] = (capacity >> 16);
141 dp[2] = (capacity >> 8);
142 dp[3] = (capacity);
143 }
144
145 #if SupportOtherDevice
usb_stor_qic157_command(Scsi_Cmnd * srb,struct us_data * us)146 void usb_stor_qic157_command(Scsi_Cmnd *srb, struct us_data *us)
147 {
148 for (; srb->cmd_len<12; srb->cmd_len++)
149 srb->cmnd[srb->cmd_len] = 0;
150
151 srb->cmd_len = 12;
152
153 usb_stor_invoke_transport(srb, us);
154 if (srb->result == SAM_STAT_GOOD) {
155 fix_inquiry_data(srb);
156 }
157 }
158
usb_stor_ATAPI_command(Scsi_Cmnd * srb,struct us_data * us)159 void usb_stor_ATAPI_command(Scsi_Cmnd *srb, struct us_data *us)
160 {
161
162 for (; srb->cmd_len<12; srb->cmd_len++)
163 srb->cmnd[srb->cmd_len] = 0;
164
165 srb->cmd_len = 12;
166
167 usb_stor_invoke_transport(srb, us);
168
169 if (srb->result == SAM_STAT_GOOD) {
170 fix_inquiry_data(srb);
171 }
172 }
173
174
usb_stor_ufi_command(Scsi_Cmnd * srb,struct us_data * us)175 void usb_stor_ufi_command(Scsi_Cmnd *srb, struct us_data *us)
176 {
177 for (; srb->cmd_len<12; srb->cmd_len++)
178 srb->cmnd[srb->cmd_len] = 0;
179
180 srb->cmd_len = 12;
181
182 switch (srb->cmnd[0]) {
183
184 case INQUIRY:
185 srb->cmnd[4] = 36;
186 break;
187
188 //case MODE_SENSE_10:
189 case MODE_SENSE: //GGYY
190 srb->cmnd[7] = 0;
191 srb->cmnd[8] = 8;
192 break;
193
194 case REQUEST_SENSE:
195 srb->cmnd[4] = 18;
196 break;
197 } /* end switch on cmnd[0] */
198
199 usb_stor_invoke_transport(srb, us);
200
201 if (srb->result == SAM_STAT_GOOD) {
202 fix_inquiry_data(srb);
203 }
204 }
205 #endif
206
usb_stor_transparent_scsi_command(Scsi_Cmnd * srb,struct us_data * us)207 void usb_stor_transparent_scsi_command(Scsi_Cmnd *srb, struct us_data *us)
208 {
209 usb_stor_invoke_transport(srb, us);
210
211 if (srb->result == SAM_STAT_GOOD) {
212 fix_inquiry_data(srb);
213
214 if (us->flags & US_FL_FIX_CAPACITY)
215 fix_read_capacity(srb);
216 }
217 }
218 #endif //#
219
220