xref: /utopia/UTPA2-700.0.x/modules/usb/drv/usb_ecos/usbhost/drvHCD.c (revision 53ee8cc121a030b8d368113ac3e966b4705770ef)
1*53ee8cc1Swenshuai.xi //<MStar Software>
2*53ee8cc1Swenshuai.xi //******************************************************************************
3*53ee8cc1Swenshuai.xi // MStar Software
4*53ee8cc1Swenshuai.xi // Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
5*53ee8cc1Swenshuai.xi // All software, firmware and related documentation herein ("MStar Software") are
6*53ee8cc1Swenshuai.xi // intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
7*53ee8cc1Swenshuai.xi // law, including, but not limited to, copyright law and international treaties.
8*53ee8cc1Swenshuai.xi // Any use, modification, reproduction, retransmission, or republication of all
9*53ee8cc1Swenshuai.xi // or part of MStar Software is expressly prohibited, unless prior written
10*53ee8cc1Swenshuai.xi // permission has been granted by MStar.
11*53ee8cc1Swenshuai.xi //
12*53ee8cc1Swenshuai.xi // By accessing, browsing and/or using MStar Software, you acknowledge that you
13*53ee8cc1Swenshuai.xi // have read, understood, and agree, to be bound by below terms ("Terms") and to
14*53ee8cc1Swenshuai.xi // comply with all applicable laws and regulations:
15*53ee8cc1Swenshuai.xi //
16*53ee8cc1Swenshuai.xi // 1. MStar shall retain any and all right, ownership and interest to MStar
17*53ee8cc1Swenshuai.xi //    Software and any modification/derivatives thereof.
18*53ee8cc1Swenshuai.xi //    No right, ownership, or interest to MStar Software and any
19*53ee8cc1Swenshuai.xi //    modification/derivatives thereof is transferred to you under Terms.
20*53ee8cc1Swenshuai.xi //
21*53ee8cc1Swenshuai.xi // 2. You understand that MStar Software might include, incorporate or be
22*53ee8cc1Swenshuai.xi //    supplied together with third party`s software and the use of MStar
23*53ee8cc1Swenshuai.xi //    Software may require additional licenses from third parties.
24*53ee8cc1Swenshuai.xi //    Therefore, you hereby agree it is your sole responsibility to separately
25*53ee8cc1Swenshuai.xi //    obtain any and all third party right and license necessary for your use of
26*53ee8cc1Swenshuai.xi //    such third party`s software.
27*53ee8cc1Swenshuai.xi //
28*53ee8cc1Swenshuai.xi // 3. MStar Software and any modification/derivatives thereof shall be deemed as
29*53ee8cc1Swenshuai.xi //    MStar`s confidential information and you agree to keep MStar`s
30*53ee8cc1Swenshuai.xi //    confidential information in strictest confidence and not disclose to any
31*53ee8cc1Swenshuai.xi //    third party.
32*53ee8cc1Swenshuai.xi //
33*53ee8cc1Swenshuai.xi // 4. MStar Software is provided on an "AS IS" basis without warranties of any
34*53ee8cc1Swenshuai.xi //    kind. Any warranties are hereby expressly disclaimed by MStar, including
35*53ee8cc1Swenshuai.xi //    without limitation, any warranties of merchantability, non-infringement of
36*53ee8cc1Swenshuai.xi //    intellectual property rights, fitness for a particular purpose, error free
37*53ee8cc1Swenshuai.xi //    and in conformity with any international standard.  You agree to waive any
38*53ee8cc1Swenshuai.xi //    claim against MStar for any loss, damage, cost or expense that you may
39*53ee8cc1Swenshuai.xi //    incur related to your use of MStar Software.
40*53ee8cc1Swenshuai.xi //    In no event shall MStar be liable for any direct, indirect, incidental or
41*53ee8cc1Swenshuai.xi //    consequential damages, including without limitation, lost of profit or
42*53ee8cc1Swenshuai.xi //    revenues, lost or damage of data, and unauthorized system use.
43*53ee8cc1Swenshuai.xi //    You agree that this Section 4 shall still apply without being affected
44*53ee8cc1Swenshuai.xi //    even if MStar Software has been modified by MStar in accordance with your
45*53ee8cc1Swenshuai.xi //    request or instruction for your use, except otherwise agreed by both
46*53ee8cc1Swenshuai.xi //    parties in writing.
47*53ee8cc1Swenshuai.xi //
48*53ee8cc1Swenshuai.xi // 5. If requested, MStar may from time to time provide technical supports or
49*53ee8cc1Swenshuai.xi //    services in relation with MStar Software to you for your use of
50*53ee8cc1Swenshuai.xi //    MStar Software in conjunction with your or your customer`s product
51*53ee8cc1Swenshuai.xi //    ("Services").
52*53ee8cc1Swenshuai.xi //    You understand and agree that, except otherwise agreed by both parties in
53*53ee8cc1Swenshuai.xi //    writing, Services are provided on an "AS IS" basis and the warranty
54*53ee8cc1Swenshuai.xi //    disclaimer set forth in Section 4 above shall apply.
55*53ee8cc1Swenshuai.xi //
56*53ee8cc1Swenshuai.xi // 6. Nothing contained herein shall be construed as by implication, estoppels
57*53ee8cc1Swenshuai.xi //    or otherwise:
58*53ee8cc1Swenshuai.xi //    (a) conferring any license or right to use MStar name, trademark, service
59*53ee8cc1Swenshuai.xi //        mark, symbol or any other identification;
60*53ee8cc1Swenshuai.xi //    (b) obligating MStar or any of its affiliates to furnish any person,
61*53ee8cc1Swenshuai.xi //        including without limitation, you and your customers, any assistance
62*53ee8cc1Swenshuai.xi //        of any kind whatsoever, or any information; or
63*53ee8cc1Swenshuai.xi //    (c) conferring any license or right under any intellectual property right.
64*53ee8cc1Swenshuai.xi //
65*53ee8cc1Swenshuai.xi // 7. These terms shall be governed by and construed in accordance with the laws
66*53ee8cc1Swenshuai.xi //    of Taiwan, R.O.C., excluding its conflict of law rules.
67*53ee8cc1Swenshuai.xi //    Any and all dispute arising out hereof or related hereto shall be finally
68*53ee8cc1Swenshuai.xi //    settled by arbitration referred to the Chinese Arbitration Association,
69*53ee8cc1Swenshuai.xi //    Taipei in accordance with the ROC Arbitration Law and the Arbitration
70*53ee8cc1Swenshuai.xi //    Rules of the Association by three (3) arbitrators appointed in accordance
71*53ee8cc1Swenshuai.xi //    with the said Rules.
72*53ee8cc1Swenshuai.xi //    The place of arbitration shall be in Taipei, Taiwan and the language shall
73*53ee8cc1Swenshuai.xi //    be English.
74*53ee8cc1Swenshuai.xi //    The arbitration award shall be final and binding to both parties.
75*53ee8cc1Swenshuai.xi //
76*53ee8cc1Swenshuai.xi //******************************************************************************
77*53ee8cc1Swenshuai.xi //<MStar Software>
78*53ee8cc1Swenshuai.xi 
79*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
80*53ee8cc1Swenshuai.xi 
81*53ee8cc1Swenshuai.xi #include <MsCommon.h>
82*53ee8cc1Swenshuai.xi #ifdef CONFIG_USB_DEBUG
83*53ee8cc1Swenshuai.xi #define DEBUG
84*53ee8cc1Swenshuai.xi #endif
85*53ee8cc1Swenshuai.xi 
86*53ee8cc1Swenshuai.xi 
87*53ee8cc1Swenshuai.xi #include  "include/drvConfig.h"
88*53ee8cc1Swenshuai.xi #include  "include/drvCompiler.h"
89*53ee8cc1Swenshuai.xi #include  "include/drvErrno.h"
90*53ee8cc1Swenshuai.xi #include  "include/drvPorts.h"
91*53ee8cc1Swenshuai.xi #include  "include/drvPCIMEM.h"
92*53ee8cc1Swenshuai.xi #include  "include/drvIO.h"
93*53ee8cc1Swenshuai.xi #include  "include/drvTimer.h"
94*53ee8cc1Swenshuai.xi #include  "include/drvList.h"
95*53ee8cc1Swenshuai.xi #include  "include/drvCompletion.h"
96*53ee8cc1Swenshuai.xi #include  "include/drvOSAPI.h"
97*53ee8cc1Swenshuai.xi #include  "include/drvKernel.h"
98*53ee8cc1Swenshuai.xi #include  "include/drvBitops.h"
99*53ee8cc1Swenshuai.xi #include <cyg/hal/hal_if.h>
100*53ee8cc1Swenshuai.xi #include <cyg/hal/hal_cache.h>
101*53ee8cc1Swenshuai.xi 
102*53ee8cc1Swenshuai.xi // USB related header files
103*53ee8cc1Swenshuai.xi #include "include/drvUSB.h"
104*53ee8cc1Swenshuai.xi #include "drvHCD.h"
105*53ee8cc1Swenshuai.xi #include "drvEHCI.h"
106*53ee8cc1Swenshuai.xi #include "drvMassStor.h"
107*53ee8cc1Swenshuai.xi 
108*53ee8cc1Swenshuai.xi extern void Chip_Flush_Memory(void);
109*53ee8cc1Swenshuai.xi 
110*53ee8cc1Swenshuai.xi 
111*53ee8cc1Swenshuai.xi #if 1
112*53ee8cc1Swenshuai.xi 
113*53ee8cc1Swenshuai.xi 
114*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
115*53ee8cc1Swenshuai.xi 
116*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
117*53ee8cc1Swenshuai.xi LIST_HEAD (usb_bus_list);
118*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
119*53ee8cc1Swenshuai.xi 
120*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
121*53ee8cc1Swenshuai.xi #define USB_MAXBUS    32
122*53ee8cc1Swenshuai.xi struct usb_busmap {
123*53ee8cc1Swenshuai.xi   U32 busmap [USB_MAXBUS / (8*sizeof (U32))];
124*53ee8cc1Swenshuai.xi };
125*53ee8cc1Swenshuai.xi static struct usb_busmap busmap;
126*53ee8cc1Swenshuai.xi 
127*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
128*53ee8cc1Swenshuai.xi 
129*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
130*53ee8cc1Swenshuai.xi 
131*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
132*53ee8cc1Swenshuai.xi 
133*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
134*53ee8cc1Swenshuai.xi 
135*53ee8cc1Swenshuai.xi #define KERNEL_REL  1
136*53ee8cc1Swenshuai.xi #define KERNEL_VER  10
137*53ee8cc1Swenshuai.xi 
138*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
139*53ee8cc1Swenshuai.xi static const unsigned char usb2_rh_dev_descriptor [18] = {
140*53ee8cc1Swenshuai.xi   0x12,
141*53ee8cc1Swenshuai.xi   0x01,
142*53ee8cc1Swenshuai.xi   0x00, 0x02,
143*53ee8cc1Swenshuai.xi 
144*53ee8cc1Swenshuai.xi   0x09,
145*53ee8cc1Swenshuai.xi   0x00,
146*53ee8cc1Swenshuai.xi   0x01,
147*53ee8cc1Swenshuai.xi   0x08,
148*53ee8cc1Swenshuai.xi 
149*53ee8cc1Swenshuai.xi   0x00, 0x00,
150*53ee8cc1Swenshuai.xi    0x00, 0x00,
151*53ee8cc1Swenshuai.xi   KERNEL_VER, KERNEL_REL,
152*53ee8cc1Swenshuai.xi 
153*53ee8cc1Swenshuai.xi   0x03,
154*53ee8cc1Swenshuai.xi   0x02,
155*53ee8cc1Swenshuai.xi   0x01,
156*53ee8cc1Swenshuai.xi   0x01
157*53ee8cc1Swenshuai.xi };
158*53ee8cc1Swenshuai.xi 
159*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
160*53ee8cc1Swenshuai.xi static const unsigned char usb11_rh_dev_descriptor [18] = {
161*53ee8cc1Swenshuai.xi   0x12,
162*53ee8cc1Swenshuai.xi   0x01,
163*53ee8cc1Swenshuai.xi   0x10, 0x01,
164*53ee8cc1Swenshuai.xi 
165*53ee8cc1Swenshuai.xi   0x09,
166*53ee8cc1Swenshuai.xi   0x00,
167*53ee8cc1Swenshuai.xi   0x00,
168*53ee8cc1Swenshuai.xi   0x08,
169*53ee8cc1Swenshuai.xi 
170*53ee8cc1Swenshuai.xi   0x00, 0x00,
171*53ee8cc1Swenshuai.xi    0x00, 0x00,
172*53ee8cc1Swenshuai.xi   KERNEL_VER, KERNEL_REL,
173*53ee8cc1Swenshuai.xi 
174*53ee8cc1Swenshuai.xi   0x03,
175*53ee8cc1Swenshuai.xi   0x02,
176*53ee8cc1Swenshuai.xi   0x01,
177*53ee8cc1Swenshuai.xi   0x01
178*53ee8cc1Swenshuai.xi };
179*53ee8cc1Swenshuai.xi 
180*53ee8cc1Swenshuai.xi 
181*53ee8cc1Swenshuai.xi 
182*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
183*53ee8cc1Swenshuai.xi static const unsigned char fs_rh_config_descriptor [] = {
184*53ee8cc1Swenshuai.xi 
185*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
186*53ee8cc1Swenshuai.xi   0x09,
187*53ee8cc1Swenshuai.xi   0x02,
188*53ee8cc1Swenshuai.xi   0x19, 0x00,
189*53ee8cc1Swenshuai.xi   0x01,
190*53ee8cc1Swenshuai.xi   0x01,
191*53ee8cc1Swenshuai.xi   0x00,
192*53ee8cc1Swenshuai.xi   0x40,
193*53ee8cc1Swenshuai.xi          /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
194*53ee8cc1Swenshuai.xi   0x00,
195*53ee8cc1Swenshuai.xi 
196*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
197*53ee8cc1Swenshuai.xi   0x09,
198*53ee8cc1Swenshuai.xi   0x04,
199*53ee8cc1Swenshuai.xi   0x00,
200*53ee8cc1Swenshuai.xi   0x00,
201*53ee8cc1Swenshuai.xi   0x01,
202*53ee8cc1Swenshuai.xi   0x09,
203*53ee8cc1Swenshuai.xi   0x00,
204*53ee8cc1Swenshuai.xi   0x00,
205*53ee8cc1Swenshuai.xi   0x00,
206*53ee8cc1Swenshuai.xi 
207*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
208*53ee8cc1Swenshuai.xi   0x07,
209*53ee8cc1Swenshuai.xi   0x05,
210*53ee8cc1Swenshuai.xi   0x81,
211*53ee8cc1Swenshuai.xi    0x03,
212*53ee8cc1Swenshuai.xi    0x02, 0x00,
213*53ee8cc1Swenshuai.xi   0xff
214*53ee8cc1Swenshuai.xi };
215*53ee8cc1Swenshuai.xi 
216*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
217*53ee8cc1Swenshuai.xi static const unsigned char hs_rh_config_descriptor [] = {
218*53ee8cc1Swenshuai.xi 
219*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
220*53ee8cc1Swenshuai.xi   0x09,
221*53ee8cc1Swenshuai.xi   0x02,
222*53ee8cc1Swenshuai.xi   0x19, 0x00,
223*53ee8cc1Swenshuai.xi   0x01,
224*53ee8cc1Swenshuai.xi   0x01,
225*53ee8cc1Swenshuai.xi   0x00,
226*53ee8cc1Swenshuai.xi   0x40,
227*53ee8cc1Swenshuai.xi        /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
228*53ee8cc1Swenshuai.xi 
229*53ee8cc1Swenshuai.xi 
230*53ee8cc1Swenshuai.xi 
231*53ee8cc1Swenshuai.xi   0x00,
232*53ee8cc1Swenshuai.xi 
233*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
234*53ee8cc1Swenshuai.xi   0x09,
235*53ee8cc1Swenshuai.xi   0x04,
236*53ee8cc1Swenshuai.xi   0x00,
237*53ee8cc1Swenshuai.xi   0x00,
238*53ee8cc1Swenshuai.xi   0x01,
239*53ee8cc1Swenshuai.xi   0x09,
240*53ee8cc1Swenshuai.xi   0x00,
241*53ee8cc1Swenshuai.xi   0x00,
242*53ee8cc1Swenshuai.xi   0x00,
243*53ee8cc1Swenshuai.xi 
244*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
245*53ee8cc1Swenshuai.xi   0x07,
246*53ee8cc1Swenshuai.xi   0x05,
247*53ee8cc1Swenshuai.xi   0x81,
248*53ee8cc1Swenshuai.xi    0x03,
249*53ee8cc1Swenshuai.xi    0x02, 0x00,
250*53ee8cc1Swenshuai.xi   0x0c
251*53ee8cc1Swenshuai.xi };
252*53ee8cc1Swenshuai.xi 
253*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
254*53ee8cc1Swenshuai.xi 
255*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
ascii2utf(char * s,unsigned char * utf,int utfmax)256*53ee8cc1Swenshuai.xi static int ascii2utf (char *s, unsigned char *utf, int utfmax)
257*53ee8cc1Swenshuai.xi {
258*53ee8cc1Swenshuai.xi   int retval;
259*53ee8cc1Swenshuai.xi 
260*53ee8cc1Swenshuai.xi   for (retval = 0; *s && utfmax > 1; utfmax -= 2, retval += 2) {
261*53ee8cc1Swenshuai.xi     *utf++ = *s++;
262*53ee8cc1Swenshuai.xi     *utf++ = 0;
263*53ee8cc1Swenshuai.xi   }
264*53ee8cc1Swenshuai.xi   return retval;
265*53ee8cc1Swenshuai.xi }
266*53ee8cc1Swenshuai.xi 
267*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_string(int id,struct usb_hcd * hcd,unsigned char * data,int len)268*53ee8cc1Swenshuai.xi static int rh_string (
269*53ee8cc1Swenshuai.xi   int    id,
270*53ee8cc1Swenshuai.xi   struct usb_hcd  *hcd,
271*53ee8cc1Swenshuai.xi   unsigned char    *data,
272*53ee8cc1Swenshuai.xi   int    len
273*53ee8cc1Swenshuai.xi ) {
274*53ee8cc1Swenshuai.xi   char buf [100];
275*53ee8cc1Swenshuai.xi 
276*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
277*53ee8cc1Swenshuai.xi   if (id == 0) {
278*53ee8cc1Swenshuai.xi     *data++ = 4; *data++ = 3;
279*53ee8cc1Swenshuai.xi     *data++ = 0x09; *data++ = 0x04;
280*53ee8cc1Swenshuai.xi     return 4;
281*53ee8cc1Swenshuai.xi 
282*53ee8cc1Swenshuai.xi  /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
283*53ee8cc1Swenshuai.xi   } else if (id == 1) {
284*53ee8cc1Swenshuai.xi     strncpy(buf, hcd->self.bus_name, sizeof(buf));
285*53ee8cc1Swenshuai.xi 
286*53ee8cc1Swenshuai.xi  /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
287*53ee8cc1Swenshuai.xi   } else if (id == 2) {
288*53ee8cc1Swenshuai.xi                 strncpy(buf, hcd->product_desc, sizeof(buf));
289*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
290*53ee8cc1Swenshuai.xi   } else if (id == 3) {
291*53ee8cc1Swenshuai.xi       USB_sprintf(buf,"%s %s %s", "Non-OS", "1.0",
292*53ee8cc1Swenshuai.xi       hcd->description);
293*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
294*53ee8cc1Swenshuai.xi   } else
295*53ee8cc1Swenshuai.xi       return 0;
296*53ee8cc1Swenshuai.xi   data [0] = 2 * (strlen(buf) + 1);
297*53ee8cc1Swenshuai.xi   data [1] = 3;  /* type == string */
298*53ee8cc1Swenshuai.xi   return 2 + ascii2utf (buf, data + 2, len - 2);
299*53ee8cc1Swenshuai.xi }
300*53ee8cc1Swenshuai.xi 
301*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
302*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
303*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
304*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
305*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
306*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
307*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
308*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
309*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
310*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
311*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
312*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
313*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
314*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
315*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
316*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
317*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
318*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
319*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
320*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
321*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_call_control(struct usb_hcd * hcd,struct urb * urb)322*53ee8cc1Swenshuai.xi static int rh_call_control (struct usb_hcd *hcd, struct urb *urb)
323*53ee8cc1Swenshuai.xi {
324*53ee8cc1Swenshuai.xi   struct usb_ctrlrequest *cmd = (struct usb_ctrlrequest *) urb->setup_packet;
325*53ee8cc1Swenshuai.xi    U16    typeReq, wValue, wIndex, wLength;
326*53ee8cc1Swenshuai.xi   const unsigned char  *bufp = 0;
327*53ee8cc1Swenshuai.xi   unsigned char    *ubuf = (unsigned char*) urb->transfer_buffer;
328*53ee8cc1Swenshuai.xi   int    len = 0;
329*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
330*53ee8cc1Swenshuai.xi 
331*53ee8cc1Swenshuai.xi   urb->hcpriv = hcd;
332*53ee8cc1Swenshuai.xi 
333*53ee8cc1Swenshuai.xi   typeReq  = (cmd->bRequestType << 8) | cmd->bRequest;
334*53ee8cc1Swenshuai.xi   wValue   = LE16ToCPU (cmd->wValue);
335*53ee8cc1Swenshuai.xi   wIndex   = LE16ToCPU (cmd->wIndex);
336*53ee8cc1Swenshuai.xi   wLength  = LE16ToCPU (cmd->wLength);
337*53ee8cc1Swenshuai.xi 
338*53ee8cc1Swenshuai.xi   if (wLength > urb->transfer_buffer_length)
339*53ee8cc1Swenshuai.xi     goto error;
340*53ee8cc1Swenshuai.xi 
341*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
342*53ee8cc1Swenshuai.xi   urb->status = 0;
343*53ee8cc1Swenshuai.xi   urb->actual_length = wLength;
344*53ee8cc1Swenshuai.xi   switch (typeReq) {
345*53ee8cc1Swenshuai.xi 
346*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
347*53ee8cc1Swenshuai.xi   case DeviceRequest | USB_REQ_GET_STATUS:
348*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
349*53ee8cc1Swenshuai.xi     ubuf [0] = 1;
350*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
351*53ee8cc1Swenshuai.xi     ubuf [1] = 0;
352*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
353*53ee8cc1Swenshuai.xi   case DeviceOutRequest | USB_REQ_CLEAR_FEATURE:
354*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
355*53ee8cc1Swenshuai.xi   case DeviceOutRequest | USB_REQ_SET_FEATURE:
356*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
357*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "no device features set yet%s","\n");
358*53ee8cc1Swenshuai.xi     break;
359*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
360*53ee8cc1Swenshuai.xi   case DeviceRequest | USB_REQ_GET_CONFIGURATION:
361*53ee8cc1Swenshuai.xi     ubuf [0] = 1;
362*53ee8cc1Swenshuai.xi       /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
363*53ee8cc1Swenshuai.xi   case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
364*53ee8cc1Swenshuai.xi     break;
365*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
366*53ee8cc1Swenshuai.xi   case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
367*53ee8cc1Swenshuai.xi     switch (wValue & 0xff00) {
368*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
369*53ee8cc1Swenshuai.xi     case USB_DT_DEVICE << 8:
370*53ee8cc1Swenshuai.xi     	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
371*53ee8cc1Swenshuai.xi       if (hcd->driver->flags & HCD_USB2)
372*53ee8cc1Swenshuai.xi         bufp = usb2_rh_dev_descriptor;
373*53ee8cc1Swenshuai.xi       else if (hcd->driver->flags & HCD_USB11)
374*53ee8cc1Swenshuai.xi         bufp = usb11_rh_dev_descriptor;
375*53ee8cc1Swenshuai.xi       else
376*53ee8cc1Swenshuai.xi         goto error;
377*53ee8cc1Swenshuai.xi       len = 18;
378*53ee8cc1Swenshuai.xi       break;
379*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
380*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
381*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
382*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
383*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
384*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
385*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
386*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
387*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
388*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
389*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
390*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
391*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
392*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
393*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
394*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
395*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
396*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
397*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
398*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
399*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
400*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
401*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
402*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
403*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
404*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
405*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
406*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
407*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
408*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
409*53ee8cc1Swenshuai.xi     case USB_DT_CONFIG << 8:
410*53ee8cc1Swenshuai.xi       if (hcd->driver->flags & HCD_USB2) {
411*53ee8cc1Swenshuai.xi         bufp = hs_rh_config_descriptor;
412*53ee8cc1Swenshuai.xi         len = sizeof hs_rh_config_descriptor;
413*53ee8cc1Swenshuai.xi       } else {
414*53ee8cc1Swenshuai.xi         bufp = fs_rh_config_descriptor;
415*53ee8cc1Swenshuai.xi         len = sizeof fs_rh_config_descriptor;
416*53ee8cc1Swenshuai.xi       }
417*53ee8cc1Swenshuai.xi       break;
418*53ee8cc1Swenshuai.xi     case USB_DT_STRING << 8:
419*53ee8cc1Swenshuai.xi       urb->actual_length = rh_string (
420*53ee8cc1Swenshuai.xi         wValue & 0xff, hcd,
421*53ee8cc1Swenshuai.xi         ubuf, wLength);
422*53ee8cc1Swenshuai.xi       break;
423*53ee8cc1Swenshuai.xi     default:
424*53ee8cc1Swenshuai.xi       goto error;
425*53ee8cc1Swenshuai.xi     }
426*53ee8cc1Swenshuai.xi     break;
427*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
428*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
429*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
430*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
431*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
432*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
433*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
434*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
435*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
436*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
437*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
438*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
439*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
440*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
441*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
442*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
443*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
444*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
445*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
446*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
447*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
448*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
449*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
450*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
451*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
452*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
453*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
454*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
455*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
456*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
457*53ee8cc1Swenshuai.xi   case DeviceRequest | USB_REQ_GET_INTERFACE:
458*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
459*53ee8cc1Swenshuai.xi     ubuf [0] = 0;
460*53ee8cc1Swenshuai.xi       /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
461*53ee8cc1Swenshuai.xi   case DeviceOutRequest | USB_REQ_SET_INTERFACE:
462*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
463*53ee8cc1Swenshuai.xi     break;
464*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
465*53ee8cc1Swenshuai.xi   case DeviceOutRequest | USB_REQ_SET_ADDRESS:
466*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
467*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "[root hub] device address %d\n",
468*53ee8cc1Swenshuai.xi       wValue);
469*53ee8cc1Swenshuai.xi     break;
470*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
471*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
472*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
473*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
474*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
475*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
476*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
477*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
478*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
479*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
480*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
481*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
482*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
483*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
484*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
485*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
486*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
487*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
488*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
489*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
490*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
491*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
492*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
493*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
494*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
495*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
496*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
497*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
498*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
499*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
500*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
501*53ee8cc1Swenshuai.xi   case EndpointRequest | USB_REQ_GET_STATUS:
502*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
503*53ee8cc1Swenshuai.xi     ubuf [0] = 0;
504*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
505*53ee8cc1Swenshuai.xi     ubuf [1] = 0;
506*53ee8cc1Swenshuai.xi       /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
507*53ee8cc1Swenshuai.xi   case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
508*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
509*53ee8cc1Swenshuai.xi   case EndpointOutRequest | USB_REQ_SET_FEATURE:
510*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
511*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "[no endpoint features yet]%s","\n");
512*53ee8cc1Swenshuai.xi     break;
513*53ee8cc1Swenshuai.xi 
514*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
515*53ee8cc1Swenshuai.xi   default:
516*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
517*53ee8cc1Swenshuai.xi     urb->status = hcd->driver->hub_control (hcd,
518*53ee8cc1Swenshuai.xi       typeReq, wValue, wIndex,
519*53ee8cc1Swenshuai.xi       (char*) ubuf, wLength);
520*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
521*53ee8cc1Swenshuai.xi     break;
522*53ee8cc1Swenshuai.xi error:
523*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
524*53ee8cc1Swenshuai.xi     urb->status = -EPIPE;
525*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "[unsupported hub control message] (maxchild %d)\n",
526*53ee8cc1Swenshuai.xi         urb->dev->maxchild);
527*53ee8cc1Swenshuai.xi   }
528*53ee8cc1Swenshuai.xi   if (urb->status) {
529*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
530*53ee8cc1Swenshuai.xi     urb->actual_length = 0;
531*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
532*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "CTRL: TypeReq=0x%x val=0x%x idx=0x%x len=%d ==> %d\n",
533*53ee8cc1Swenshuai.xi       typeReq, wValue, wIndex, wLength, urb->status);
534*53ee8cc1Swenshuai.xi   }
535*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
536*53ee8cc1Swenshuai.xi   if (bufp) {
537*53ee8cc1Swenshuai.xi     if (urb->transfer_buffer_length < len)
538*53ee8cc1Swenshuai.xi       len = urb->transfer_buffer_length;
539*53ee8cc1Swenshuai.xi     urb->actual_length = len;
540*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
541*53ee8cc1Swenshuai.xi     memcpy(ubuf, bufp, len);
542*53ee8cc1Swenshuai.xi   }
543*53ee8cc1Swenshuai.xi 
544*53ee8cc1Swenshuai.xi  /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
545*53ee8cc1Swenshuai.xi   local_irq_save (flags);
546*53ee8cc1Swenshuai.xi   usb_hcd_giveback_urb (hcd, urb, NULL);
547*53ee8cc1Swenshuai.xi   local_irq_restore (flags);
548*53ee8cc1Swenshuai.xi   return 0;
549*53ee8cc1Swenshuai.xi }
550*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
551*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
552*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
553*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
554*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
555*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
556*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
557*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
558*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
559*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
560*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
561*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
562*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
563*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
564*53ee8cc1Swenshuai.xi 
565*53ee8cc1Swenshuai.xi #ifndef ROOTHUB_INTERRUPT_MODE
566*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
567*53ee8cc1Swenshuai.xi 
568*53ee8cc1Swenshuai.xi static void rh_report_status (U32 ptr);
569*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
570*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
571*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
572*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
573*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
574*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
575*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
576*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
577*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
578*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
579*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
580*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
581*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
582*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
583*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
584*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
585*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_status_urb(struct usb_hcd * hcd,struct urb * urb)586*53ee8cc1Swenshuai.xi static int rh_status_urb (struct usb_hcd *hcd, struct urb *urb)
587*53ee8cc1Swenshuai.xi {
588*53ee8cc1Swenshuai.xi 	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
589*53ee8cc1Swenshuai.xi   int  len = 1 + (urb->dev->maxchild / 8);
590*53ee8cc1Swenshuai.xi 
591*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
592*53ee8cc1Swenshuai.xi   if (hcd->rh_timer.data
593*53ee8cc1Swenshuai.xi       || urb->status != -EINPROGRESS
594*53ee8cc1Swenshuai.xi       || urb->transfer_buffer_length < len
595*53ee8cc1Swenshuai.xi       || !HCD_IS_RUNNING (hcd->state)) {
596*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller,
597*53ee8cc1Swenshuai.xi         "not queuing rh status urb, stat %d\n",
598*53ee8cc1Swenshuai.xi         urb->status);
599*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
600*53ee8cc1Swenshuai.xi     return -EINVAL;
601*53ee8cc1Swenshuai.xi   }
602*53ee8cc1Swenshuai.xi 
603*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
604*53ee8cc1Swenshuai.xi   init_timer (&hcd->rh_timer);
605*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
606*53ee8cc1Swenshuai.xi   hcd->rh_timer.function = rh_report_status;
607*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
608*53ee8cc1Swenshuai.xi   hcd->rh_timer.data = (U32) &hcd->rh_timer;
609*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
610*53ee8cc1Swenshuai.xi   hcd->rh_timer.data_ex = (U32) urb;
611*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
612*53ee8cc1Swenshuai.xi   hcd->rh_timer.tmout_value = ROOTHUB_TIMER_INTERVAL;
613*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
614*53ee8cc1Swenshuai.xi   add_timer (&hcd->rh_timer);
615*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
616*53ee8cc1Swenshuai.xi   urb->hcpriv = hcd;
617*53ee8cc1Swenshuai.xi   return 0;
618*53ee8cc1Swenshuai.xi }
619*53ee8cc1Swenshuai.xi 
620*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
621*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
622*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
623*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
624*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
625*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
626*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
627*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
628*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
629*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
630*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_report_status(U32 ptr)631*53ee8cc1Swenshuai.xi static void rh_report_status (U32 ptr)
632*53ee8cc1Swenshuai.xi {
633*53ee8cc1Swenshuai.xi   struct timer_list *pTimer = (struct timer_list *) ptr;
634*53ee8cc1Swenshuai.xi   struct urb  *urb;
635*53ee8cc1Swenshuai.xi   struct usb_hcd  *hcd;
636*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
637*53ee8cc1Swenshuai.xi   int length = 0;
638*53ee8cc1Swenshuai.xi   //U32  flags;
639*53ee8cc1Swenshuai.xi   urb = (struct urb *) pTimer->data_ex;
640*53ee8cc1Swenshuai.xi   local_irq_save (flags);
641*53ee8cc1Swenshuai.xi   spin_lock (&urb->lock);
642*53ee8cc1Swenshuai.xi 
643*53ee8cc1Swenshuai.xi  /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
644*53ee8cc1Swenshuai.xi 
645*53ee8cc1Swenshuai.xi   if (!urb->dev
646*53ee8cc1Swenshuai.xi       || urb->status != -EINPROGRESS
647*53ee8cc1Swenshuai.xi       || (hcd = (struct usb_hcd*) urb->dev->bus->hcpriv) == 0) {
648*53ee8cc1Swenshuai.xi     spin_unlock (&urb->lock);
649*53ee8cc1Swenshuai.xi     local_irq_restore (flags);
650*53ee8cc1Swenshuai.xi 	diag_printf("rh_report_status: it's unlinked. urb->status: 0x%\n", urb->status);
651*53ee8cc1Swenshuai.xi     return;
652*53ee8cc1Swenshuai.xi   }
653*53ee8cc1Swenshuai.xi 
654*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
655*53ee8cc1Swenshuai.xi   #if 1
656*53ee8cc1Swenshuai.xi   length = hcd->driver->hub_status_data (hcd, (char*) urb->transfer_buffer);
657*53ee8cc1Swenshuai.xi   #else
658*53ee8cc1Swenshuai.xi   if (!HCD_IS_SUSPENDED (hcd->state))
659*53ee8cc1Swenshuai.xi     length = hcd->driver->hub_status_data (hcd, urb->transfer_buffer);
660*53ee8cc1Swenshuai.xi   #endif
661*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
662*53ee8cc1Swenshuai.xi   spin_lock (&hcd_data_lock);
663*53ee8cc1Swenshuai.xi   if (length > 0) {
664*53ee8cc1Swenshuai.xi     hcd->rh_timer.data = 0;
665*53ee8cc1Swenshuai.xi     urb->actual_length = length;
666*53ee8cc1Swenshuai.xi     urb->status = 0;
667*53ee8cc1Swenshuai.xi     urb->hcpriv = 0;
668*53ee8cc1Swenshuai.xi   }
669*53ee8cc1Swenshuai.xi   else
670*53ee8cc1Swenshuai.xi     mod_timer (&hcd->rh_timer, ROOTHUB_TIMER_INTERVAL, 0);
671*53ee8cc1Swenshuai.xi   spin_unlock (&hcd_data_lock);
672*53ee8cc1Swenshuai.xi   spin_unlock (&urb->lock);
673*53ee8cc1Swenshuai.xi 
674*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
675*53ee8cc1Swenshuai.xi   if (length > 0)
676*53ee8cc1Swenshuai.xi     usb_hcd_giveback_urb (hcd, urb, NULL);
677*53ee8cc1Swenshuai.xi   local_irq_restore (flags);
678*53ee8cc1Swenshuai.xi }
679*53ee8cc1Swenshuai.xi 
680*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
681*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
682*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
683*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
684*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
685*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
686*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
687*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
688*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
689*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
690*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
691*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
692*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
693*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
694*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
695*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
696*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
697*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
698*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
699*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
700*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_urb_enqueue(struct usb_hcd * hcd,struct urb * urb)701*53ee8cc1Swenshuai.xi static int rh_urb_enqueue (struct usb_hcd *hcd, struct urb *urb)
702*53ee8cc1Swenshuai.xi {
703*53ee8cc1Swenshuai.xi   if (usb_pipeint (urb->pipe)) {
704*53ee8cc1Swenshuai.xi     int    retval;
705*53ee8cc1Swenshuai.xi     U32  flags;
706*53ee8cc1Swenshuai.xi 
707*53ee8cc1Swenshuai.xi     spin_lock_irqsave (&hcd_data_lock, flags);
708*53ee8cc1Swenshuai.xi     retval = rh_status_urb (hcd, urb);
709*53ee8cc1Swenshuai.xi     spin_unlock_irqrestore (&hcd_data_lock, flags);
710*53ee8cc1Swenshuai.xi     return retval;
711*53ee8cc1Swenshuai.xi   }
712*53ee8cc1Swenshuai.xi   if (usb_pipecontrol (urb->pipe))
713*53ee8cc1Swenshuai.xi     return rh_call_control (hcd, urb);
714*53ee8cc1Swenshuai.xi   else
715*53ee8cc1Swenshuai.xi     return -EINVAL;
716*53ee8cc1Swenshuai.xi }
717*53ee8cc1Swenshuai.xi 
718*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
719*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
720*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
721*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
722*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
723*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
724*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
725*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
726*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
727*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
728*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_rh_status_dequeue(struct usb_hcd * hcd,struct urb * urb)729*53ee8cc1Swenshuai.xi void usb_rh_status_dequeue (struct usb_hcd *hcd, struct urb *urb)
730*53ee8cc1Swenshuai.xi {
731*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
732*53ee8cc1Swenshuai.xi   del_timer_sync (&hcd->rh_timer);
733*53ee8cc1Swenshuai.xi   hcd->rh_timer.data = 0;
734*53ee8cc1Swenshuai.xi 
735*53ee8cc1Swenshuai.xi   local_irq_save (flags);
736*53ee8cc1Swenshuai.xi   urb->hcpriv = 0;
737*53ee8cc1Swenshuai.xi   usb_hcd_giveback_urb (hcd, urb, NULL);
738*53ee8cc1Swenshuai.xi   local_irq_restore (flags);
739*53ee8cc1Swenshuai.xi }
740*53ee8cc1Swenshuai.xi 
741*53ee8cc1Swenshuai.xi #endif
742*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
743*53ee8cc1Swenshuai.xi #ifdef   ROOTHUB_INTERRUPT_MODE
744*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
745*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
746*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
747*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
748*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
749*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
750*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
751*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
752*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
753*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
754*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_hcd_poll_rh_status(struct usb_hcd * hcd)755*53ee8cc1Swenshuai.xi void usb_hcd_poll_rh_status(struct usb_hcd *hcd)
756*53ee8cc1Swenshuai.xi {
757*53ee8cc1Swenshuai.xi 	struct urb	*urb;
758*53ee8cc1Swenshuai.xi 	int		length;
759*53ee8cc1Swenshuai.xi 	unsigned long	flags;
760*53ee8cc1Swenshuai.xi 	char		buffer[4];
761*53ee8cc1Swenshuai.xi 
762*53ee8cc1Swenshuai.xi 	if (unlikely(!hcd->rh_registered))
763*53ee8cc1Swenshuai.xi 		return;
764*53ee8cc1Swenshuai.xi 	if (!hcd->uses_new_polling && !hcd->status_urb)
765*53ee8cc1Swenshuai.xi 		return;
766*53ee8cc1Swenshuai.xi 
767*53ee8cc1Swenshuai.xi 	length = hcd->driver->hub_status_data(hcd, buffer);
768*53ee8cc1Swenshuai.xi 	if (length > 0) {
769*53ee8cc1Swenshuai.xi 
770*53ee8cc1Swenshuai.xi 		/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
771*53ee8cc1Swenshuai.xi 		spin_lock_irqsave(&hcd_root_hub_lock, flags);
772*53ee8cc1Swenshuai.xi 		urb = hcd->status_urb;
773*53ee8cc1Swenshuai.xi 		if (urb) {
774*53ee8cc1Swenshuai.xi 			hcd->poll_pending = 0;
775*53ee8cc1Swenshuai.xi 			hcd->status_urb = NULL;
776*53ee8cc1Swenshuai.xi 			urb->actual_length = length;
777*53ee8cc1Swenshuai.xi                         urb->status = 0; // update status
778*53ee8cc1Swenshuai.xi                         urb->hcpriv = 0;
779*53ee8cc1Swenshuai.xi 			memcpy(urb->transfer_buffer, buffer, length);
780*53ee8cc1Swenshuai.xi 
781*53ee8cc1Swenshuai.xi       /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
782*53ee8cc1Swenshuai.xi 			spin_unlock(&hcd_root_hub_lock);
783*53ee8cc1Swenshuai.xi 			usb_hcd_giveback_urb(hcd, urb, NULL);
784*53ee8cc1Swenshuai.xi 			spin_lock(&hcd_root_hub_lock);
785*53ee8cc1Swenshuai.xi 		} else {
786*53ee8cc1Swenshuai.xi 			length = 0;
787*53ee8cc1Swenshuai.xi 			hcd->poll_pending = 1;
788*53ee8cc1Swenshuai.xi 		}
789*53ee8cc1Swenshuai.xi 		spin_unlock_irqrestore(&hcd_root_hub_lock, flags);
790*53ee8cc1Swenshuai.xi 	}
791*53ee8cc1Swenshuai.xi 
792*53ee8cc1Swenshuai.xi 	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
793*53ee8cc1Swenshuai.xi 	if (hcd->uses_new_polling ? hcd->poll_rh :
794*53ee8cc1Swenshuai.xi 			(length == 0 && hcd->status_urb != NULL))
795*53ee8cc1Swenshuai.xi 		mod_timer (&hcd->rh_timer, (jiffies/(HZ/4) + 1) * (HZ/4), 0);
796*53ee8cc1Swenshuai.xi }
797*53ee8cc1Swenshuai.xi 
798*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
rh_timer_func(unsigned long _hcd)799*53ee8cc1Swenshuai.xi void rh_timer_func (unsigned long _hcd)
800*53ee8cc1Swenshuai.xi {
801*53ee8cc1Swenshuai.xi 	usb_hcd_poll_rh_status((struct usb_hcd *) _hcd);
802*53ee8cc1Swenshuai.xi }
803*53ee8cc1Swenshuai.xi 
804*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
805*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
806*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
807*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
808*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
809*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
810*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
811*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
812*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
813*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
814*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
815*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
816*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
817*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
818*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
819*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
820*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
821*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
822*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
823*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
824*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
825*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
826*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
827*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
828*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
829*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
830*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
831*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
832*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
833*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
834*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
835*53ee8cc1Swenshuai.xi 
rh_queue_status(struct usb_hcd * hcd,struct urb * urb)836*53ee8cc1Swenshuai.xi static int rh_queue_status (struct usb_hcd *hcd, struct urb *urb)
837*53ee8cc1Swenshuai.xi {
838*53ee8cc1Swenshuai.xi 	int		retval;
839*53ee8cc1Swenshuai.xi 	unsigned long	flags;
840*53ee8cc1Swenshuai.xi 	int		len = 1 + (urb->dev->maxchild / 8);
841*53ee8cc1Swenshuai.xi 
842*53ee8cc1Swenshuai.xi 	spin_lock_irqsave (&hcd_root_hub_lock, flags);
843*53ee8cc1Swenshuai.xi 	if (hcd->status_urb || urb->transfer_buffer_length < len) {
844*53ee8cc1Swenshuai.xi 		dev_dbg (hcd->self.controller, "not queuing rh status urb\n");
845*53ee8cc1Swenshuai.xi 		retval = -EINVAL;
846*53ee8cc1Swenshuai.xi 		goto done;
847*53ee8cc1Swenshuai.xi 	}
848*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
849*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
850*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
851*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
852*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
853*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
854*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
855*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
856*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
857*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
858*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
859*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
860*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
861*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
862*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
863*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
864*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
865*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
866*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
867*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
868*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
869*53ee8cc1Swenshuai.xi 
870*53ee8cc1Swenshuai.xi 	hcd->status_urb = urb;
871*53ee8cc1Swenshuai.xi 	urb->hcpriv = hcd;	/* indicate it's queued */
872*53ee8cc1Swenshuai.xi 	if (!hcd->uses_new_polling)
873*53ee8cc1Swenshuai.xi 		mod_timer(&hcd->rh_timer, (jiffies/(HZ/4) + 1) * (HZ/4), 0);
874*53ee8cc1Swenshuai.xi 
875*53ee8cc1Swenshuai.xi 	/* If a status change has already occurred, report it ASAP */
876*53ee8cc1Swenshuai.xi 	else if (hcd->poll_pending)
877*53ee8cc1Swenshuai.xi 		mod_timer(&hcd->rh_timer, jiffies, 0);
878*53ee8cc1Swenshuai.xi 	retval = 0;
879*53ee8cc1Swenshuai.xi  done:
880*53ee8cc1Swenshuai.xi 	spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
881*53ee8cc1Swenshuai.xi 	return retval;
882*53ee8cc1Swenshuai.xi }
883*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
884*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
885*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
886*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
887*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
888*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
889*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
890*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
891*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
892*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
893*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
894*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
895*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
896*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
897*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
898*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
899*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
900*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
901*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
902*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
903*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
904*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
905*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
906*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
907*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
908*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
909*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
910*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
911*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
912*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
913*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
914*53ee8cc1Swenshuai.xi 
rh_urb_enqueue(struct usb_hcd * hcd,struct urb * urb)915*53ee8cc1Swenshuai.xi static int rh_urb_enqueue (struct usb_hcd *hcd, struct urb *urb)
916*53ee8cc1Swenshuai.xi {
917*53ee8cc1Swenshuai.xi   if (usb_pipeint (urb->pipe)) {
918*53ee8cc1Swenshuai.xi     int    retval;
919*53ee8cc1Swenshuai.xi     U32  flags;
920*53ee8cc1Swenshuai.xi 
921*53ee8cc1Swenshuai.xi //diag_printf("<rh_urb_enqueue>...\n");
922*53ee8cc1Swenshuai.xi     spin_lock_irqsave (&hcd_data_lock, flags);
923*53ee8cc1Swenshuai.xi     retval = rh_queue_status (hcd, urb);
924*53ee8cc1Swenshuai.xi     spin_unlock_irqrestore (&hcd_data_lock, flags);
925*53ee8cc1Swenshuai.xi     return retval;
926*53ee8cc1Swenshuai.xi   }
927*53ee8cc1Swenshuai.xi   else if (usb_pipecontrol (urb->pipe))
928*53ee8cc1Swenshuai.xi     return rh_call_control (hcd, urb);
929*53ee8cc1Swenshuai.xi   else
930*53ee8cc1Swenshuai.xi     return -EINVAL;
931*53ee8cc1Swenshuai.xi }
932*53ee8cc1Swenshuai.xi 
933*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
934*53ee8cc1Swenshuai.xi 
usb_rh_status_dequeue(struct usb_hcd * hcd,struct urb * urb)935*53ee8cc1Swenshuai.xi void usb_rh_status_dequeue (struct usb_hcd *hcd, struct urb *urb)
936*53ee8cc1Swenshuai.xi {
937*53ee8cc1Swenshuai.xi    unsigned long   flags;
938*53ee8cc1Swenshuai.xi    //int     rc;
939*53ee8cc1Swenshuai.xi 
940*53ee8cc1Swenshuai.xi diag_printf("<usb_rh_status_dequeue>\n");
941*53ee8cc1Swenshuai.xi    spin_lock_irqsave(&hcd_root_hub_lock, flags);
942*53ee8cc1Swenshuai.xi    /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
943*53ee8cc1Swenshuai.xi    if (usb_pipecontrol (urb->pipe)) {    /* Control URB */
944*53ee8cc1Swenshuai.xi        ;   /* Do nothing */
945*53ee8cc1Swenshuai.xi 
946*53ee8cc1Swenshuai.xi    } else {                /* Status URB */
947*53ee8cc1Swenshuai.xi        if (!hcd->uses_new_polling)
948*53ee8cc1Swenshuai.xi            del_timer (&hcd->rh_timer);
949*53ee8cc1Swenshuai.xi        if (urb == hcd->status_urb) {
950*53ee8cc1Swenshuai.xi            hcd->status_urb = NULL;
951*53ee8cc1Swenshuai.xi            // TODO: FIXME
952*53ee8cc1Swenshuai.xi            //usb_hcd_unlink_urb_from_ep(hcd, urb);
953*53ee8cc1Swenshuai.xi 
954*53ee8cc1Swenshuai.xi            spin_unlock(&hcd_root_hub_lock);
955*53ee8cc1Swenshuai.xi            usb_hcd_giveback_urb(hcd, urb, NULL);
956*53ee8cc1Swenshuai.xi            spin_lock(&hcd_root_hub_lock);
957*53ee8cc1Swenshuai.xi        }
958*53ee8cc1Swenshuai.xi    }
959*53ee8cc1Swenshuai.xi //done:
960*53ee8cc1Swenshuai.xi    spin_unlock_irqrestore(&hcd_root_hub_lock, flags);
961*53ee8cc1Swenshuai.xi    //return rc;
962*53ee8cc1Swenshuai.xi }
963*53ee8cc1Swenshuai.xi #endif
964*53ee8cc1Swenshuai.xi 
965*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
966*53ee8cc1Swenshuai.xi 
967*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
968*53ee8cc1Swenshuai.xi 
usb_bus_get(struct usb_bus * bus)969*53ee8cc1Swenshuai.xi struct usb_bus *usb_bus_get (struct usb_bus *bus)
970*53ee8cc1Swenshuai.xi {
971*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
972*53ee8cc1Swenshuai.xi   return bus;
973*53ee8cc1Swenshuai.xi }
974*53ee8cc1Swenshuai.xi 
975*53ee8cc1Swenshuai.xi 
976*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
977*53ee8cc1Swenshuai.xi 
usb_bus_put(struct usb_bus * bus)978*53ee8cc1Swenshuai.xi void usb_bus_put (struct usb_bus *bus)
979*53ee8cc1Swenshuai.xi {
980*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
981*53ee8cc1Swenshuai.xi }
982*53ee8cc1Swenshuai.xi 
983*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
984*53ee8cc1Swenshuai.xi 
985*53ee8cc1Swenshuai.xi 
986*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
987*53ee8cc1Swenshuai.xi 
usb_host_init(void)988*53ee8cc1Swenshuai.xi void usb_host_init(void)
989*53ee8cc1Swenshuai.xi {
990*53ee8cc1Swenshuai.xi   //class_register(&usb_host_class);
991*53ee8cc1Swenshuai.xi }
992*53ee8cc1Swenshuai.xi 
usb_host_cleanup(void)993*53ee8cc1Swenshuai.xi void usb_host_cleanup(void)
994*53ee8cc1Swenshuai.xi {
995*53ee8cc1Swenshuai.xi   //class_unregister(&usb_host_class);
996*53ee8cc1Swenshuai.xi }
997*53ee8cc1Swenshuai.xi 
998*53ee8cc1Swenshuai.xi 
999*53ee8cc1Swenshuai.xi 
1000*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_bus_init(struct usb_bus * bus)1001*53ee8cc1Swenshuai.xi void usb_bus_init (struct usb_bus *bus)
1002*53ee8cc1Swenshuai.xi {
1003*53ee8cc1Swenshuai.xi   memset (&bus->devmap, 0, sizeof(struct usb_devmap));
1004*53ee8cc1Swenshuai.xi 
1005*53ee8cc1Swenshuai.xi   bus->devnum_next = 1;
1006*53ee8cc1Swenshuai.xi 
1007*53ee8cc1Swenshuai.xi   bus->root_hub = NULL;
1008*53ee8cc1Swenshuai.xi   bus->hcpriv = NULL;
1009*53ee8cc1Swenshuai.xi   bus->otgpriv = NULL;
1010*53ee8cc1Swenshuai.xi   bus->busnum = -1;
1011*53ee8cc1Swenshuai.xi   bus->bandwidth_allocated = 0;
1012*53ee8cc1Swenshuai.xi   bus->bandwidth_int_reqs  = 0;
1013*53ee8cc1Swenshuai.xi   bus->bandwidth_isoc_reqs = 0;
1014*53ee8cc1Swenshuai.xi 
1015*53ee8cc1Swenshuai.xi   INIT_LIST_HEAD (&bus->bus_list);
1016*53ee8cc1Swenshuai.xi }
1017*53ee8cc1Swenshuai.xi 
1018*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1019*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1020*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1021*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1022*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1023*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1024*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1025*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1026*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1027*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1028*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1029*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1030*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1031*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1032*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1033*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1034*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1035*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1036*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1037*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1038*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1039*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1040*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1041*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1042*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1043*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1044*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1045*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1046*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1047*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1048*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_alloc_bus(struct usb_operations * op)1049*53ee8cc1Swenshuai.xi struct usb_bus *usb_alloc_bus (struct usb_operations *op)
1050*53ee8cc1Swenshuai.xi {
1051*53ee8cc1Swenshuai.xi   struct usb_bus *bus;
1052*53ee8cc1Swenshuai.xi 
1053*53ee8cc1Swenshuai.xi   bus = (struct usb_bus*) kmalloc (sizeof *bus, GFP_KERNEL);
1054*53ee8cc1Swenshuai.xi   if (!bus)
1055*53ee8cc1Swenshuai.xi     return NULL;
1056*53ee8cc1Swenshuai.xi   memset(bus, 0, sizeof(struct usb_bus));
1057*53ee8cc1Swenshuai.xi   usb_bus_init (bus);
1058*53ee8cc1Swenshuai.xi   bus->op = op;
1059*53ee8cc1Swenshuai.xi   return bus;
1060*53ee8cc1Swenshuai.xi }
1061*53ee8cc1Swenshuai.xi //EXPORT_SYMBOL (usb_alloc_bus);
1062*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1063*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1064*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1065*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1066*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1067*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1068*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1069*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1070*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1071*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1072*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1073*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1074*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1075*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1076*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1077*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1078*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1079*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1080*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1081*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1082*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1083*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1084*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1085*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1086*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1087*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1088*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1089*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1090*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1091*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1092*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_register_bus(struct usb_bus * bus)1093*53ee8cc1Swenshuai.xi int usb_register_bus(struct usb_bus *bus)
1094*53ee8cc1Swenshuai.xi {
1095*53ee8cc1Swenshuai.xi   int busnum;
1096*53ee8cc1Swenshuai.xi   //int retval;
1097*53ee8cc1Swenshuai.xi 
1098*53ee8cc1Swenshuai.xi   down (&usb_bus_list_lock);
1099*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1100*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1101*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1102*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1103*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1104*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1105*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1106*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1107*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1108*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1109*53ee8cc1Swenshuai.xi   busnum = find_next_zero_bit (busmap.busmap, USB_MAXBUS, 1);
1110*53ee8cc1Swenshuai.xi   if (busnum < USB_MAXBUS) {
1111*53ee8cc1Swenshuai.xi     set_bit (busnum, busmap.busmap, U32);
1112*53ee8cc1Swenshuai.xi     bus->busnum = busnum;
1113*53ee8cc1Swenshuai.xi     dbg("The busnum is %d",busnum);
1114*53ee8cc1Swenshuai.xi   } else
1115*53ee8cc1Swenshuai.xi     usb_warn ("too many buses%s","");
1116*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1117*53ee8cc1Swenshuai.xi   list_add (&bus->bus_list, &usb_bus_list);
1118*53ee8cc1Swenshuai.xi   up (&usb_bus_list_lock);
1119*53ee8cc1Swenshuai.xi 
1120*53ee8cc1Swenshuai.xi   usbfs_add_bus (bus);
1121*53ee8cc1Swenshuai.xi 
1122*53ee8cc1Swenshuai.xi   dev_info (bus->controller, "new USB bus registered, assigned bus number %d\n", bus->busnum);
1123*53ee8cc1Swenshuai.xi   return 0;
1124*53ee8cc1Swenshuai.xi }
1125*53ee8cc1Swenshuai.xi 
1126*53ee8cc1Swenshuai.xi 
1127*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_deregister_bus(struct usb_bus * bus)1128*53ee8cc1Swenshuai.xi void usb_deregister_bus (struct usb_bus *bus)
1129*53ee8cc1Swenshuai.xi {
1130*53ee8cc1Swenshuai.xi   dev_info (bus->controller, "USB bus %d deregistered\n", bus->busnum);
1131*53ee8cc1Swenshuai.xi 
1132*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1133*53ee8cc1Swenshuai.xi   down (&usb_bus_list_lock);
1134*53ee8cc1Swenshuai.xi   list_del (&bus->bus_list);
1135*53ee8cc1Swenshuai.xi   up (&usb_bus_list_lock);
1136*53ee8cc1Swenshuai.xi 
1137*53ee8cc1Swenshuai.xi   usbfs_remove_bus (bus);
1138*53ee8cc1Swenshuai.xi 
1139*53ee8cc1Swenshuai.xi   clear_bit (bus->busnum, busmap.busmap, U32);
1140*53ee8cc1Swenshuai.xi 
1141*53ee8cc1Swenshuai.xi   //class_device_unregister(&bus->class_dev);
1142*53ee8cc1Swenshuai.xi }
1143*53ee8cc1Swenshuai.xi //EXPORT_SYMBOL (usb_deregister_bus);
1144*53ee8cc1Swenshuai.xi 
1145*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_register_root_hub(struct usb_device * usb_dev,struct device_s * parent_dev)1146*53ee8cc1Swenshuai.xi int usb_register_root_hub (struct usb_device *usb_dev, struct device_s *parent_dev)
1147*53ee8cc1Swenshuai.xi {
1148*53ee8cc1Swenshuai.xi   const int devnum = 1;
1149*53ee8cc1Swenshuai.xi   int retval;
1150*53ee8cc1Swenshuai.xi 
1151*53ee8cc1Swenshuai.xi   USB_sprintf (&usb_dev->dev.bus_id[0],
1152*53ee8cc1Swenshuai.xi      		/*sizeof(usb_dev->dev.bus_id), */ "usb%ld-rh", usb_dev->bus->busnum);
1153*53ee8cc1Swenshuai.xi   usb_dev->state = USB_STATE_DEFAULT;
1154*53ee8cc1Swenshuai.xi 
1155*53ee8cc1Swenshuai.xi   usb_dev->devnum = devnum;
1156*53ee8cc1Swenshuai.xi   usb_dev->bus->devnum_next = devnum + 1;
1157*53ee8cc1Swenshuai.xi   set_bit (devnum, usb_dev->bus->devmap.devicemap, U32);
1158*53ee8cc1Swenshuai.xi 
1159*53ee8cc1Swenshuai.xi   retval = usb_new_device (usb_dev, parent_dev);
1160*53ee8cc1Swenshuai.xi   if (retval)
1161*53ee8cc1Swenshuai.xi     dev_err (parent_dev, "can't register root hub for %s, %d\n",
1162*53ee8cc1Swenshuai.xi         usb_dev->dev.bus_id, retval);
1163*53ee8cc1Swenshuai.xi   return retval;
1164*53ee8cc1Swenshuai.xi }
1165*53ee8cc1Swenshuai.xi //EXPORT_SYMBOL (usb_register_root_hub);
1166*53ee8cc1Swenshuai.xi 
1167*53ee8cc1Swenshuai.xi #ifdef ROOTHUB_INTERRUPT_MODE
1168*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
register_root_hub(struct usb_hcd * hcd)1169*53ee8cc1Swenshuai.xi int register_root_hub(struct usb_hcd *hcd)
1170*53ee8cc1Swenshuai.xi {
1171*53ee8cc1Swenshuai.xi 	//struct device *parent_dev = hcd->self.controller;
1172*53ee8cc1Swenshuai.xi         struct device_s *parent_dev = hcd->controller;
1173*53ee8cc1Swenshuai.xi 	struct usb_device *usb_dev = hcd->self.root_hub;
1174*53ee8cc1Swenshuai.xi 	const int devnum = 1;
1175*53ee8cc1Swenshuai.xi 	int retval;
1176*53ee8cc1Swenshuai.xi 
1177*53ee8cc1Swenshuai.xi         usb_dev->state = USB_STATE_DEFAULT;
1178*53ee8cc1Swenshuai.xi 
1179*53ee8cc1Swenshuai.xi         usb_dev->devnum = devnum;
1180*53ee8cc1Swenshuai.xi         usb_dev->bus->devnum_next = devnum + 1;
1181*53ee8cc1Swenshuai.xi         set_bit (devnum, usb_dev->bus->devmap.devicemap, U32);
1182*53ee8cc1Swenshuai.xi 
1183*53ee8cc1Swenshuai.xi         retval = usb_new_device (usb_dev, parent_dev);
1184*53ee8cc1Swenshuai.xi         if (retval)
1185*53ee8cc1Swenshuai.xi           dev_err (parent_dev, "can't register root hub for %s, %d\n",
1186*53ee8cc1Swenshuai.xi               usb_dev->dev.bus_id, retval);
1187*53ee8cc1Swenshuai.xi 
1188*53ee8cc1Swenshuai.xi 	if (retval == 0) {
1189*53ee8cc1Swenshuai.xi                 diag_printf("<register_root_hub> hcd->rh_registered = 1\n");
1190*53ee8cc1Swenshuai.xi 		spin_lock_irq (&hcd_root_hub_lock);
1191*53ee8cc1Swenshuai.xi 		hcd->rh_registered = 1;
1192*53ee8cc1Swenshuai.xi 		spin_unlock_irq (&hcd_root_hub_lock);
1193*53ee8cc1Swenshuai.xi 
1194*53ee8cc1Swenshuai.xi 		/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1195*53ee8cc1Swenshuai.xi 	}
1196*53ee8cc1Swenshuai.xi 
1197*53ee8cc1Swenshuai.xi 	return retval;
1198*53ee8cc1Swenshuai.xi }
1199*53ee8cc1Swenshuai.xi #endif
1200*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
1201*53ee8cc1Swenshuai.xi 
1202*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1203*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1204*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1205*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1206*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1207*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1208*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1209*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1210*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1211*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1212*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1213*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1214*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1215*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1216*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1217*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1218*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1219*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1220*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1221*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1222*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_calc_bus_time(int speed,int is_input,int isoc,int bytecount)1223*53ee8cc1Swenshuai.xi int usb_calc_bus_time (int speed, int is_input, int isoc, int bytecount)
1224*53ee8cc1Swenshuai.xi {
1225*53ee8cc1Swenshuai.xi 	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1226*53ee8cc1Swenshuai.xi   U32  tmp;
1227*53ee8cc1Swenshuai.xi 
1228*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1229*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1230*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1231*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1232*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1233*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1234*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1235*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1236*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1237*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1238*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1239*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1240*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1241*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1242*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1243*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1244*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1245*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1246*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1247*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1248*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1249*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1250*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1251*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1252*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1253*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1254*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1255*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1256*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1257*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1258*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1259*53ee8cc1Swenshuai.xi   switch (speed) {
1260*53ee8cc1Swenshuai.xi   case USB_SPEED_LOW:
1261*53ee8cc1Swenshuai.xi     if (is_input) {
1262*53ee8cc1Swenshuai.xi       tmp = (67667L * (31L + 10L * BitTime (bytecount))) / 1000L;
1263*53ee8cc1Swenshuai.xi       return (64060L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
1264*53ee8cc1Swenshuai.xi     } else {
1265*53ee8cc1Swenshuai.xi       tmp = (66700L * (31L + 10L * BitTime (bytecount))) / 1000L;
1266*53ee8cc1Swenshuai.xi       return (64107L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
1267*53ee8cc1Swenshuai.xi     }
1268*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1269*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1270*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1271*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1272*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1273*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1274*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1275*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1276*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1277*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1278*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1279*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1280*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1281*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1282*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1283*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1284*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1285*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1286*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1287*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1288*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1289*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1290*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1291*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1292*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1293*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1294*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1295*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1296*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1297*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1298*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1299*53ee8cc1Swenshuai.xi   case USB_SPEED_FULL:
1300*53ee8cc1Swenshuai.xi   	/*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1301*53ee8cc1Swenshuai.xi     if (isoc) {
1302*53ee8cc1Swenshuai.xi       tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
1303*53ee8cc1Swenshuai.xi       return (((is_input) ? 7268L : 6265L) + BW_HOST_DELAY + tmp);
1304*53ee8cc1Swenshuai.xi     } else {
1305*53ee8cc1Swenshuai.xi       tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
1306*53ee8cc1Swenshuai.xi       return (9107L + BW_HOST_DELAY + tmp);
1307*53ee8cc1Swenshuai.xi     }
1308*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1309*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1310*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1311*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1312*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1313*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1314*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1315*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1316*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1317*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1318*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1319*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1320*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1321*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1322*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1323*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1324*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1325*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1326*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1327*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1328*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1329*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1330*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1331*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1332*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1333*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1334*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1335*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1336*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1337*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1338*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1339*53ee8cc1Swenshuai.xi   case USB_SPEED_HIGH:
1340*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1341*53ee8cc1Swenshuai.xi     if (isoc)
1342*53ee8cc1Swenshuai.xi       tmp = HS_USECS (bytecount);
1343*53ee8cc1Swenshuai.xi     else
1344*53ee8cc1Swenshuai.xi       tmp = HS_USECS_ISO (bytecount);
1345*53ee8cc1Swenshuai.xi     return tmp;
1346*53ee8cc1Swenshuai.xi   default:
1347*53ee8cc1Swenshuai.xi     dbg ("bogus device speed!%s","");
1348*53ee8cc1Swenshuai.xi     return -1;
1349*53ee8cc1Swenshuai.xi   }
1350*53ee8cc1Swenshuai.xi }
1351*53ee8cc1Swenshuai.xi 
1352*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1353*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1354*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1355*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1356*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1357*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1358*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1359*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1360*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1361*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1362*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1363*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1364*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1365*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1366*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1367*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1368*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1369*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1370*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1371*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1372*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_claim_bandwidth(struct usb_device * dev,struct urb * urb,int bustime,int isoc)1373*53ee8cc1Swenshuai.xi void usb_claim_bandwidth (struct usb_device *dev, struct urb *urb, int bustime, int isoc)
1374*53ee8cc1Swenshuai.xi {
1375*53ee8cc1Swenshuai.xi   dev->bus->bandwidth_allocated += bustime;
1376*53ee8cc1Swenshuai.xi   if (isoc)
1377*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_isoc_reqs++;
1378*53ee8cc1Swenshuai.xi   else
1379*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_int_reqs++;
1380*53ee8cc1Swenshuai.xi   urb->bandwidth = bustime;
1381*53ee8cc1Swenshuai.xi 
1382*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1383*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1384*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1385*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1386*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1387*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1388*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1389*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1390*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1391*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1392*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1393*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1394*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1395*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1396*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1397*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1398*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1399*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1400*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1401*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1402*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1403*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1404*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1405*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1406*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1407*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1408*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1409*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1410*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1411*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1412*53ee8cc1Swenshuai.xi #ifdef USB_BANDWIDTH_MESSAGES
1413*53ee8cc1Swenshuai.xi   dev_dbg (&dev->dev, "bandwidth alloc increased by %d (%s) to %d for %d requesters\n",
1414*53ee8cc1Swenshuai.xi     bustime,
1415*53ee8cc1Swenshuai.xi     isoc ? "ISOC" : "INTR",
1416*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_allocated,
1417*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_int_reqs + dev->bus->bandwidth_isoc_reqs);
1418*53ee8cc1Swenshuai.xi #endif
1419*53ee8cc1Swenshuai.xi }
1420*53ee8cc1Swenshuai.xi 
1421*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1422*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1423*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1424*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1425*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1426*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1427*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1428*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1429*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1430*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1431*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1432*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1433*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1434*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1435*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1436*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1437*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1438*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1439*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1440*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1441*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1442*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1443*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1444*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1445*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1446*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1447*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1448*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1449*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1450*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1451*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_release_bandwidth(struct usb_device * dev,struct urb * urb,int isoc)1452*53ee8cc1Swenshuai.xi void usb_release_bandwidth (struct usb_device *dev, struct urb *urb, int isoc)
1453*53ee8cc1Swenshuai.xi {
1454*53ee8cc1Swenshuai.xi   dev->bus->bandwidth_allocated -= urb->bandwidth;
1455*53ee8cc1Swenshuai.xi   if (isoc)
1456*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_isoc_reqs--;
1457*53ee8cc1Swenshuai.xi   else
1458*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_int_reqs--;
1459*53ee8cc1Swenshuai.xi 
1460*53ee8cc1Swenshuai.xi #ifdef USB_BANDWIDTH_MESSAGES
1461*53ee8cc1Swenshuai.xi   dev_dbg (&dev->dev, "bandwidth alloc reduced by %d (%s) to %d for %d requesters\n",
1462*53ee8cc1Swenshuai.xi     urb->bandwidth,
1463*53ee8cc1Swenshuai.xi     isoc ? "ISOC" : "INTR",
1464*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_allocated,
1465*53ee8cc1Swenshuai.xi     dev->bus->bandwidth_int_reqs + dev->bus->bandwidth_isoc_reqs);
1466*53ee8cc1Swenshuai.xi #endif
1467*53ee8cc1Swenshuai.xi   urb->bandwidth = 0;
1468*53ee8cc1Swenshuai.xi }
1469*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1470*53ee8cc1Swenshuai.xi 
1471*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
1472*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1473*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1474*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1475*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1476*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1477*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1478*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1479*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1480*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1481*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1482*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1483*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1484*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1485*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1486*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1487*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1488*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1489*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1490*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1491*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1492*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1493*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1494*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1495*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1496*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1497*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1498*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1499*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1500*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1501*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1502*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
hcd_alloc_dev(struct usb_device * udev)1503*53ee8cc1Swenshuai.xi static int hcd_alloc_dev (struct usb_device *udev)
1504*53ee8cc1Swenshuai.xi {
1505*53ee8cc1Swenshuai.xi   struct hcd_dev    *dev;
1506*53ee8cc1Swenshuai.xi   struct usb_hcd    *hcd;
1507*53ee8cc1Swenshuai.xi   U32    flags;
1508*53ee8cc1Swenshuai.xi 
1509*53ee8cc1Swenshuai.xi   if (!udev || udev->hcpriv)
1510*53ee8cc1Swenshuai.xi     return -EINVAL;
1511*53ee8cc1Swenshuai.xi   if (!udev->bus || !udev->bus->hcpriv)
1512*53ee8cc1Swenshuai.xi     return -ENODEV;
1513*53ee8cc1Swenshuai.xi   hcd = (struct usb_hcd*) udev->bus->hcpriv;
1514*53ee8cc1Swenshuai.xi   if (hcd->state == USB_STATE_QUIESCING)
1515*53ee8cc1Swenshuai.xi     return -ENOLINK;
1516*53ee8cc1Swenshuai.xi 
1517*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1518*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1519*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1520*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1521*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1522*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1523*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1524*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1525*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1526*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1527*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1528*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1529*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1530*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1531*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1532*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1533*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1534*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1535*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1536*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1537*53ee8cc1Swenshuai.xi 
1538*53ee8cc1Swenshuai.xi   dev = (struct hcd_dev *) kmalloc (sizeof *dev, GFP_KERNEL);
1539*53ee8cc1Swenshuai.xi   if (dev == NULL)
1540*53ee8cc1Swenshuai.xi     return -ENOMEM;
1541*53ee8cc1Swenshuai.xi   memset (dev, 0, sizeof *dev);
1542*53ee8cc1Swenshuai.xi 
1543*53ee8cc1Swenshuai.xi   INIT_LIST_HEAD (&dev->dev_list);
1544*53ee8cc1Swenshuai.xi   INIT_LIST_HEAD (&dev->urb_list);
1545*53ee8cc1Swenshuai.xi 
1546*53ee8cc1Swenshuai.xi   spin_lock_irqsave (&hcd_data_lock, flags);
1547*53ee8cc1Swenshuai.xi   list_add (&dev->dev_list, &hcd->dev_list);
1548*53ee8cc1Swenshuai.xi 
1549*53ee8cc1Swenshuai.xi   udev->hcpriv = dev;
1550*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&hcd_data_lock, flags);
1551*53ee8cc1Swenshuai.xi 
1552*53ee8cc1Swenshuai.xi   return 0;
1553*53ee8cc1Swenshuai.xi }
1554*53ee8cc1Swenshuai.xi 
1555*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
1556*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1557*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1558*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1559*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1560*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1561*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1562*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1563*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1564*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1565*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1566*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1567*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1568*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1569*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1570*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1571*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1572*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1573*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1574*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1575*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1576*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1577*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1578*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1579*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1580*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1581*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1582*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1583*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1584*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1585*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
urb_unlink(struct urb * urb)1586*53ee8cc1Swenshuai.xi static void urb_unlink (struct urb *urb)
1587*53ee8cc1Swenshuai.xi {
1588*53ee8cc1Swenshuai.xi   U32    flags;
1589*53ee8cc1Swenshuai.xi   struct usb_device  *dev;
1590*53ee8cc1Swenshuai.xi 
1591*53ee8cc1Swenshuai.xi   /* Release any periodic transfer bandwidth */
1592*53ee8cc1Swenshuai.xi   if (urb->bandwidth)
1593*53ee8cc1Swenshuai.xi     usb_release_bandwidth (urb->dev, urb,
1594*53ee8cc1Swenshuai.xi       usb_pipeisoc (urb->pipe));
1595*53ee8cc1Swenshuai.xi 
1596*53ee8cc1Swenshuai.xi   /* clear all state linking urb to this dev (and hcd) */
1597*53ee8cc1Swenshuai.xi 
1598*53ee8cc1Swenshuai.xi   spin_lock_irqsave (&hcd_data_lock, flags);
1599*53ee8cc1Swenshuai.xi   list_del_init (&urb->urb_list);
1600*53ee8cc1Swenshuai.xi   dev = urb->dev;
1601*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&hcd_data_lock, flags);
1602*53ee8cc1Swenshuai.xi   usb_put_dev (dev);
1603*53ee8cc1Swenshuai.xi }
1604*53ee8cc1Swenshuai.xi 
1605*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
hcd_submit_urb(struct urb * urb,int mem_flags)1606*53ee8cc1Swenshuai.xi static int hcd_submit_urb (struct urb *urb, int mem_flags)
1607*53ee8cc1Swenshuai.xi {
1608*53ee8cc1Swenshuai.xi   int      status;
1609*53ee8cc1Swenshuai.xi   struct usb_hcd    *hcd = (struct usb_hcd*) urb->dev->bus->hcpriv;
1610*53ee8cc1Swenshuai.xi   struct hcd_dev    *dev = (struct hcd_dev*) urb->dev->hcpriv;
1611*53ee8cc1Swenshuai.xi   struct ehci_hcd    *ehci = hcd_to_ehci (hcd);
1612*53ee8cc1Swenshuai.xi   U32    flags;
1613*53ee8cc1Swenshuai.xi 
1614*53ee8cc1Swenshuai.xi   if (mem_flags == ASYNC_SUBMIT_QTD)
1615*53ee8cc1Swenshuai.xi     return (hcd->driver->urb_enqueue (hcd, urb, mem_flags));
1616*53ee8cc1Swenshuai.xi 
1617*53ee8cc1Swenshuai.xi   if (!hcd || !dev)
1618*53ee8cc1Swenshuai.xi     return -ENODEV;
1619*53ee8cc1Swenshuai.xi 
1620*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1621*53ee8cc1Swenshuai.xi 
1622*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1623*53ee8cc1Swenshuai.xi 
1624*53ee8cc1Swenshuai.xi   ehci->uDontSendIAA = 0;	//Set IAA interrupt (default)
1625*53ee8cc1Swenshuai.xi 
1626*53ee8cc1Swenshuai.xi   spin_lock_irqsave (&hcd_data_lock, flags);
1627*53ee8cc1Swenshuai.xi   if (HCD_IS_RUNNING (hcd->state) && hcd->state != USB_STATE_QUIESCING) {
1628*53ee8cc1Swenshuai.xi     usb_get_dev (urb->dev);
1629*53ee8cc1Swenshuai.xi     list_add_tail (&urb->urb_list, &dev->urb_list);
1630*53ee8cc1Swenshuai.xi     status = 0;
1631*53ee8cc1Swenshuai.xi   } else {
1632*53ee8cc1Swenshuai.xi     INIT_LIST_HEAD (&urb->urb_list);
1633*53ee8cc1Swenshuai.xi     diag_printf("hcd_submit_urb return ESHUTDOWN !!! hcd->state = %x\n", hcd->state);
1634*53ee8cc1Swenshuai.xi     status = -ESHUTDOWN;
1635*53ee8cc1Swenshuai.xi   }
1636*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&hcd_data_lock, flags);
1637*53ee8cc1Swenshuai.xi   if (status)
1638*53ee8cc1Swenshuai.xi     return status;
1639*53ee8cc1Swenshuai.xi 
1640*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1641*53ee8cc1Swenshuai.xi   urb = usb_get_urb (urb);
1642*53ee8cc1Swenshuai.xi   if (urb->dev == hcd->self.root_hub) {
1643*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1644*53ee8cc1Swenshuai.xi     urb->transfer_flags |= (URB_NO_TRANSFER_DMA_MAP
1645*53ee8cc1Swenshuai.xi           | URB_NO_SETUP_DMA_MAP);
1646*53ee8cc1Swenshuai.xi     status = rh_urb_enqueue (hcd, urb);
1647*53ee8cc1Swenshuai.xi     goto done;
1648*53ee8cc1Swenshuai.xi   }
1649*53ee8cc1Swenshuai.xi 
1650*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1651*53ee8cc1Swenshuai.xi 
1652*53ee8cc1Swenshuai.xi 
1653*53ee8cc1Swenshuai.xi   if (hcd->controller->dma_mask) {
1654*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1655*53ee8cc1Swenshuai.xi   }
1656*53ee8cc1Swenshuai.xi   else
1657*53ee8cc1Swenshuai.xi   {
1658*53ee8cc1Swenshuai.xi     // Non DMA support
1659*53ee8cc1Swenshuai.xi     if (usb_pipecontrol (urb->pipe))
1660*53ee8cc1Swenshuai.xi     {
1661*53ee8cc1Swenshuai.xi         //if ((((U32) urb->setup_packet) & 0xF) != 0 || ((sizeof(struct usb_ctrlrequest)  & 0xF) != 0) )
1662*53ee8cc1Swenshuai.xi         if ((((U32) urb->setup_packet) & CPU_L1_CACHE_BOUND) != 0 || ((sizeof(struct usb_ctrlrequest)  & CPU_L1_CACHE_BOUND) != 0) ) // J
1663*53ee8cc1Swenshuai.xi         {
1664*53ee8cc1Swenshuai.xi             //diag_printf("Setup address %p, length %x\n", urb->setup_packet, sizeof(struct usb_ctrlrequest));
1665*53ee8cc1Swenshuai.xi             urb->SetDMALen = sizeof(struct usb_ctrlrequest);
1666*53ee8cc1Swenshuai.xi             //urb->SetDMABuf = LIB_MemoryAllocate(urb->SetDMALen | 0xF, MALLOC_UNCACHED_ADDR);
1667*53ee8cc1Swenshuai.xi             //urb->SetDMABuf = MsOS_AllocateMemory(((urb->SetDMALen+15) & ~0xF), gs32NonCachedPoolID_MIU0 );
1668*53ee8cc1Swenshuai.xi             //urb->SetDMABuf = Usb_AllocateNonCachedMemory(((urb->SetDMALen+15) & ~0xF));
1669*53ee8cc1Swenshuai.xi             urb->SetDMABuf = Usb_AllocateNonCachedMemory(((urb->SetDMALen+CPU_L1_CACHE_BOUND) & ~CPU_L1_CACHE_BOUND)); // J
1670*53ee8cc1Swenshuai.xi 
1671*53ee8cc1Swenshuai.xi             USB_ASSERT(urb->SetDMABuf != NULL, "Allocate SetDMABuf error\n");
1672*53ee8cc1Swenshuai.xi 
1673*53ee8cc1Swenshuai.xi             memcpy(urb->SetDMABuf, urb->setup_packet, urb->SetDMALen);
1674*53ee8cc1Swenshuai.xi             //HAL_DCACHE_FLUSH((void*) urb->SetDMABuf, urb->SetDMALen);
1675*53ee8cc1Swenshuai.xi 
1676*53ee8cc1Swenshuai.xi             urb->setup_dma = (dma_addr_t) USB_VA2PA((U32)urb->SetDMABuf);
1677*53ee8cc1Swenshuai.xi             //diag_printf("SetDMA address %x SetDMA length %x\n", urb->setup_dma, urb->SetDMALen);
1678*53ee8cc1Swenshuai.xi             Chip_Flush_Memory();
1679*53ee8cc1Swenshuai.xi         }
1680*53ee8cc1Swenshuai.xi 	    else
1681*53ee8cc1Swenshuai.xi 	    {
1682*53ee8cc1Swenshuai.xi             if ( urb->setup_packet != KSEG02KSEG1(urb->setup_packet) )
1683*53ee8cc1Swenshuai.xi 			    //HAL_DCACHE_FLUSH((void*) urb->setup_packet, sizeof(struct usb_ctrlrequest));
1684*53ee8cc1Swenshuai.xi 			    MsOS_Dcache_Flush((U32) urb->setup_packet, sizeof(struct usb_ctrlrequest));
1685*53ee8cc1Swenshuai.xi 
1686*53ee8cc1Swenshuai.xi             urb->setup_dma = (dma_addr_t) USB_VA2PA((U32)urb->setup_packet);
1687*53ee8cc1Swenshuai.xi 	        //diag_printf("Setup DMA address %x DMA length %x\n", urb->setup_dma, sizeof(struct usb_ctrlrequest));
1688*53ee8cc1Swenshuai.xi             Chip_Flush_Memory();
1689*53ee8cc1Swenshuai.xi 	    }
1690*53ee8cc1Swenshuai.xi 	    USB_ASSERT((urb->setup_dma & 0xF) == 0, "DMA address is not 16 bytes aligned\n");
1691*53ee8cc1Swenshuai.xi 	//OS_Assert((sizeof(struct usb_ctrlrequest) & 0xF) == 0, "DMA length is not 16 bytes aligned\n");
1692*53ee8cc1Swenshuai.xi 
1693*53ee8cc1Swenshuai.xi    }
1694*53ee8cc1Swenshuai.xi 
1695*53ee8cc1Swenshuai.xi     if (urb->transfer_buffer_length != 0)
1696*53ee8cc1Swenshuai.xi     {
1697*53ee8cc1Swenshuai.xi #if 0			//yuwen, mass storage //USB_2 remove
1698*53ee8cc1Swenshuai.xi 	  if ((Mass_stor_us!=NULL)&& ( urb->transfer_buffer == Mass_stor_us->iobuf ))
1699*53ee8cc1Swenshuai.xi         {
1700*53ee8cc1Swenshuai.xi 		urb->transfer_dma= (dma_addr_t) USB_VA2PA((U32)urb->transfer_buffer);
1701*53ee8cc1Swenshuai.xi         }
1702*53ee8cc1Swenshuai.xi         else
1703*53ee8cc1Swenshuai.xi #endif
1704*53ee8cc1Swenshuai.xi         {
1705*53ee8cc1Swenshuai.xi             //if ((((U32) urb->transfer_buffer) & 0xF) != 0 || ((urb->transfer_buffer_length  & 0xF) != 0) )
1706*53ee8cc1Swenshuai.xi             if ((((U32) urb->transfer_buffer) & CPU_L1_CACHE_BOUND) != 0 || ((urb->transfer_buffer_length  & CPU_L1_CACHE_BOUND) != 0) ) // J
1707*53ee8cc1Swenshuai.xi             {
1708*53ee8cc1Swenshuai.xi                 //diag_printf("<hcd_submit_urb> bouncing A[%x], L[%d]\n", urb->transfer_buffer, urb->transfer_buffer_length);
1709*53ee8cc1Swenshuai.xi                 #ifdef DEBUG_PERFORMANCE
1710*53ee8cc1Swenshuai.xi                 if (urb->transfer_buffer_length >= 512)
1711*53ee8cc1Swenshuai.xi                     diag_printf("DMA address %x DMA length %x\n", urb->transfer_buffer, urb->transfer_buffer_length);
1712*53ee8cc1Swenshuai.xi                 #endif
1713*53ee8cc1Swenshuai.xi                 urb->TxDMALen= urb->transfer_buffer_length;
1714*53ee8cc1Swenshuai.xi                 //urb->TxDMABuf = LIB_MemoryAllocate(urb->TxDMALen | 0xF, MALLOC_UNCACHED_ADDR);
1715*53ee8cc1Swenshuai.xi                 //urb->TxDMABuf = MsOS_AllocateMemory(((urb->TxDMALen+15) & ~0xF), gs32NonCachedPoolID_MIU0 );
1716*53ee8cc1Swenshuai.xi                 //urb->TxDMABuf = Usb_AllocateNonCachedMemory(((urb->TxDMALen+15) & ~0xF));
1717*53ee8cc1Swenshuai.xi                 urb->TxDMABuf = Usb_AllocateNonCachedMemory(((urb->TxDMALen+CPU_L1_CACHE_BOUND) & ~CPU_L1_CACHE_BOUND)); // J
1718*53ee8cc1Swenshuai.xi                 USB_ASSERT(urb->TxDMABuf != NULL, "Allocate TxDMABuf error\n");
1719*53ee8cc1Swenshuai.xi 
1720*53ee8cc1Swenshuai.xi                 if (!usb_pipein(urb->pipe))
1721*53ee8cc1Swenshuai.xi                 {
1722*53ee8cc1Swenshuai.xi                     memcpy(urb->TxDMABuf, urb->transfer_buffer, urb->transfer_buffer_length);
1723*53ee8cc1Swenshuai.xi                 }
1724*53ee8cc1Swenshuai.xi 
1725*53ee8cc1Swenshuai.xi                 urb->transfer_dma= (dma_addr_t) USB_VA2PA((U32)urb->TxDMABuf);
1726*53ee8cc1Swenshuai.xi                 //diag_printf("TxDMA address %x TxDMA length %x\n", urb->transfer_dma, urb->TxDMALen);
1727*53ee8cc1Swenshuai.xi             }
1728*53ee8cc1Swenshuai.xi             else
1729*53ee8cc1Swenshuai.xi             {
1730*53ee8cc1Swenshuai.xi                 if (  urb->transfer_buffer != KSEG02KSEG1(urb->transfer_buffer) )
1731*53ee8cc1Swenshuai.xi                 {
1732*53ee8cc1Swenshuai.xi                     if (usb_pipein(urb->pipe))
1733*53ee8cc1Swenshuai.xi                         //HAL_DCACHE_INVALIDATE((void*) urb->transfer_buffer, urb->transfer_buffer_length);
1734*53ee8cc1Swenshuai.xi                         //MsOS_Dcache_Invalidate((U32) urb->transfer_buffer, urb->transfer_buffer_length);
1735*53ee8cc1Swenshuai.xi                         MsOS_Dcache_Flush((U32) urb->transfer_buffer, urb->transfer_buffer_length);
1736*53ee8cc1Swenshuai.xi                         //MsOS_Dcache_Invalidate seems to cause stack crashed... , change to MsOS_Dcache_Flush temporiarly
1737*53ee8cc1Swenshuai.xi 
1738*53ee8cc1Swenshuai.xi                     else
1739*53ee8cc1Swenshuai.xi                         //HAL_DCACHE_FLUSH((void*) urb->transfer_buffer, urb->transfer_buffer_length);
1740*53ee8cc1Swenshuai.xi                         MsOS_Dcache_Flush((U32) urb->transfer_buffer, urb->transfer_buffer_length);
1741*53ee8cc1Swenshuai.xi 
1742*53ee8cc1Swenshuai.xi                 }
1743*53ee8cc1Swenshuai.xi 
1744*53ee8cc1Swenshuai.xi                 urb->transfer_dma= (dma_addr_t) USB_VA2PA((U32)urb->transfer_buffer);
1745*53ee8cc1Swenshuai.xi                 //diag_printf("DMA address %x DMA length %x\n", urb->transfer_dma, urb->transfer_buffer_length);
1746*53ee8cc1Swenshuai.xi             }
1747*53ee8cc1Swenshuai.xi         }
1748*53ee8cc1Swenshuai.xi         USB_ASSERT((urb->transfer_dma & 0xF) == 0, "DMA address is not 16 bytes aligned\n");
1749*53ee8cc1Swenshuai.xi         //OS_Assert((urb->transfer_buffer_length & 0xF) == 0, "DMA length is not 16 bytes aligned\n");
1750*53ee8cc1Swenshuai.xi     }
1751*53ee8cc1Swenshuai.xi   }
1752*53ee8cc1Swenshuai.xi 
1753*53ee8cc1Swenshuai.xi 
1754*53ee8cc1Swenshuai.xi   status = hcd->driver->urb_enqueue (hcd, urb, mem_flags);
1755*53ee8cc1Swenshuai.xi done:
1756*53ee8cc1Swenshuai.xi   if (status) {
1757*53ee8cc1Swenshuai.xi     usb_put_urb (urb);
1758*53ee8cc1Swenshuai.xi     urb_unlink (urb);
1759*53ee8cc1Swenshuai.xi   }
1760*53ee8cc1Swenshuai.xi   return status;
1761*53ee8cc1Swenshuai.xi }
1762*53ee8cc1Swenshuai.xi 
1763*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
1764*53ee8cc1Swenshuai.xi 
1765*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
hcd_get_frame_number(struct usb_device * udev)1766*53ee8cc1Swenshuai.xi static int hcd_get_frame_number (struct usb_device *udev)
1767*53ee8cc1Swenshuai.xi {
1768*53ee8cc1Swenshuai.xi   struct usb_hcd  *hcd = (struct usb_hcd *)udev->bus->hcpriv;
1769*53ee8cc1Swenshuai.xi   if (!HCD_IS_RUNNING (hcd->state))
1770*53ee8cc1Swenshuai.xi   {
1771*53ee8cc1Swenshuai.xi     diag_printf("hcd_get_frame_number return ESHUTDOWN !!!\n");
1772*53ee8cc1Swenshuai.xi     return -ESHUTDOWN;
1773*53ee8cc1Swenshuai.xi   }
1774*53ee8cc1Swenshuai.xi   return hcd->driver->get_frame_number (hcd);
1775*53ee8cc1Swenshuai.xi }
1776*53ee8cc1Swenshuai.xi 
1777*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
1778*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1779*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1780*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1781*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1782*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1783*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1784*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1785*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1786*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1787*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1788*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1789*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1790*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1791*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1792*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1793*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1794*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1795*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1796*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1797*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1798*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1799*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1800*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1801*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1802*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1803*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1804*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1805*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1806*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1807*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1808*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1809*53ee8cc1Swenshuai.xi static void
unlink1(struct usb_hcd * hcd,struct urb * urb)1810*53ee8cc1Swenshuai.xi unlink1 (struct usb_hcd *hcd, struct urb *urb)
1811*53ee8cc1Swenshuai.xi {
1812*53ee8cc1Swenshuai.xi   if (urb == (struct urb *) hcd->rh_timer.data)
1813*53ee8cc1Swenshuai.xi     usb_rh_status_dequeue (hcd, urb);
1814*53ee8cc1Swenshuai.xi   else {
1815*53ee8cc1Swenshuai.xi     int    value;
1816*53ee8cc1Swenshuai.xi 
1817*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1818*53ee8cc1Swenshuai.xi     value = hcd->driver->urb_dequeue (hcd, urb);
1819*53ee8cc1Swenshuai.xi     if (value != 0)
1820*53ee8cc1Swenshuai.xi       dev_dbg (hcd->controller,
1821*53ee8cc1Swenshuai.xi         "dequeue %p --> %d\n",
1822*53ee8cc1Swenshuai.xi         urb, value);
1823*53ee8cc1Swenshuai.xi   }
1824*53ee8cc1Swenshuai.xi }
1825*53ee8cc1Swenshuai.xi 
1826*53ee8cc1Swenshuai.xi struct completion_splice {    // modified urb context:
1827*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1828*53ee8cc1Swenshuai.xi   struct completion  done;
1829*53ee8cc1Swenshuai.xi 
1830*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1831*53ee8cc1Swenshuai.xi   usb_complete_t    complete;
1832*53ee8cc1Swenshuai.xi   void      *context;
1833*53ee8cc1Swenshuai.xi };
1834*53ee8cc1Swenshuai.xi 
unlink_complete(struct urb * urb,struct pt_regs * regs)1835*53ee8cc1Swenshuai.xi static void unlink_complete (struct urb *urb, struct pt_regs *regs)
1836*53ee8cc1Swenshuai.xi {
1837*53ee8cc1Swenshuai.xi   struct completion_splice  *splice;
1838*53ee8cc1Swenshuai.xi 
1839*53ee8cc1Swenshuai.xi   splice = (struct completion_splice *) urb->context;
1840*53ee8cc1Swenshuai.xi 
1841*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1842*53ee8cc1Swenshuai.xi   urb->complete = splice->complete;
1843*53ee8cc1Swenshuai.xi   urb->context = splice->context;
1844*53ee8cc1Swenshuai.xi   urb->complete (urb, regs);  //Callback function
1845*53ee8cc1Swenshuai.xi 
1846*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1847*53ee8cc1Swenshuai.xi   complete (&splice->done);
1848*53ee8cc1Swenshuai.xi }
1849*53ee8cc1Swenshuai.xi 
1850*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1851*53ee8cc1Swenshuai.xi extern void USB_HW_Reset(struct usb_hcd* pUsbHcd/*, struct usb_device *pUsbDev*/);
hcd_unlink_urb(struct urb * urb)1852*53ee8cc1Swenshuai.xi static int hcd_unlink_urb (struct urb *urb)
1853*53ee8cc1Swenshuai.xi {
1854*53ee8cc1Swenshuai.xi   struct hcd_dev      *dev;
1855*53ee8cc1Swenshuai.xi   struct usb_hcd      *hcd = 0;
1856*53ee8cc1Swenshuai.xi   struct device_s      *sys = 0;
1857*53ee8cc1Swenshuai.xi   U32      flags;
1858*53ee8cc1Swenshuai.xi   struct completion_splice  splice;
1859*53ee8cc1Swenshuai.xi   int        retval;
1860*53ee8cc1Swenshuai.xi   U32    d_cnt = 0;
1861*53ee8cc1Swenshuai.xi 
1862*53ee8cc1Swenshuai.xi   if (!urb)
1863*53ee8cc1Swenshuai.xi     return -EINVAL;
1864*53ee8cc1Swenshuai.xi 
1865*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1866*53ee8cc1Swenshuai.xi   spin_lock_irqsave (&urb->lock, flags);
1867*53ee8cc1Swenshuai.xi   spin_lock (&hcd_data_lock);
1868*53ee8cc1Swenshuai.xi 
1869*53ee8cc1Swenshuai.xi   if (!urb->dev || !urb->dev->bus) {
1870*53ee8cc1Swenshuai.xi     retval = -ENODEV;
1871*53ee8cc1Swenshuai.xi     goto done;
1872*53ee8cc1Swenshuai.xi   }
1873*53ee8cc1Swenshuai.xi 
1874*53ee8cc1Swenshuai.xi   dev = (struct hcd_dev*) urb->dev->hcpriv;
1875*53ee8cc1Swenshuai.xi   sys = &urb->dev->dev;
1876*53ee8cc1Swenshuai.xi   hcd = (struct usb_hcd*) urb->dev->bus->hcpriv;
1877*53ee8cc1Swenshuai.xi   if (!dev || !hcd) {
1878*53ee8cc1Swenshuai.xi     retval = -ENODEV;
1879*53ee8cc1Swenshuai.xi     goto done;
1880*53ee8cc1Swenshuai.xi   }
1881*53ee8cc1Swenshuai.xi 
1882*53ee8cc1Swenshuai.xi   if (!urb->hcpriv) {
1883*53ee8cc1Swenshuai.xi     retval = -EINVAL;
1884*53ee8cc1Swenshuai.xi     goto done;
1885*53ee8cc1Swenshuai.xi   }
1886*53ee8cc1Swenshuai.xi 
1887*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1888*53ee8cc1Swenshuai.xi   if (urb->status != -EINPROGRESS) {
1889*53ee8cc1Swenshuai.xi     retval = -EBUSY;
1890*53ee8cc1Swenshuai.xi     goto done;
1891*53ee8cc1Swenshuai.xi   }
1892*53ee8cc1Swenshuai.xi 
1893*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1894*53ee8cc1Swenshuai.xi   if (!(urb->transfer_flags & URB_ASYNC_UNLINK)) {
1895*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1896*53ee8cc1Swenshuai.xi     init_completion (&splice.done);
1897*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1898*53ee8cc1Swenshuai.xi     splice.complete = urb->complete;
1899*53ee8cc1Swenshuai.xi     splice.context = urb->context;
1900*53ee8cc1Swenshuai.xi     urb->complete = unlink_complete;
1901*53ee8cc1Swenshuai.xi     urb->context = &splice;
1902*53ee8cc1Swenshuai.xi     urb->status = -ENOENT;
1903*53ee8cc1Swenshuai.xi   } else {
1904*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1905*53ee8cc1Swenshuai.xi     urb->status = -ECONNRESET;
1906*53ee8cc1Swenshuai.xi   }
1907*53ee8cc1Swenshuai.xi   spin_unlock (&hcd_data_lock);
1908*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&urb->lock, flags);
1909*53ee8cc1Swenshuai.xi 
1910*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1911*53ee8cc1Swenshuai.xi   if (urb == (struct urb *) hcd->rh_timer.data) {
1912*53ee8cc1Swenshuai.xi     usb_rh_status_dequeue (hcd, urb);
1913*53ee8cc1Swenshuai.xi     retval = 0;
1914*53ee8cc1Swenshuai.xi   } else {
1915*53ee8cc1Swenshuai.xi     retval = hcd->driver->urb_dequeue (hcd, urb);
1916*53ee8cc1Swenshuai.xi 
1917*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1918*53ee8cc1Swenshuai.xi     if (retval) {
1919*53ee8cc1Swenshuai.xi       dev_dbg (sys, "dequeue %p --> %d\n", urb, retval);
1920*53ee8cc1Swenshuai.xi       if (!(urb->transfer_flags & URB_ASYNC_UNLINK)) {
1921*53ee8cc1Swenshuai.xi         spin_lock_irqsave (&urb->lock, flags);
1922*53ee8cc1Swenshuai.xi         urb->complete = splice.complete;
1923*53ee8cc1Swenshuai.xi         urb->context = splice.context;
1924*53ee8cc1Swenshuai.xi         spin_unlock_irqrestore (&urb->lock, flags);
1925*53ee8cc1Swenshuai.xi       }
1926*53ee8cc1Swenshuai.xi       goto bye;
1927*53ee8cc1Swenshuai.xi     }
1928*53ee8cc1Swenshuai.xi   }
1929*53ee8cc1Swenshuai.xi 
1930*53ee8cc1Swenshuai.xi       /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1931*53ee8cc1Swenshuai.xi   if (urb->transfer_flags & URB_ASYNC_UNLINK)
1932*53ee8cc1Swenshuai.xi     return -EINPROGRESS;
1933*53ee8cc1Swenshuai.xi 
1934*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1935*53ee8cc1Swenshuai.xi   while ( splice.done.done == 0 )
1936*53ee8cc1Swenshuai.xi   {
1937*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1938*53ee8cc1Swenshuai.xi     if ( d_cnt > (U32) 3000)
1939*53ee8cc1Swenshuai.xi     {
1940*53ee8cc1Swenshuai.xi       break;
1941*53ee8cc1Swenshuai.xi     }
1942*53ee8cc1Swenshuai.xi     else
1943*53ee8cc1Swenshuai.xi     {
1944*53ee8cc1Swenshuai.xi       HAL_DELAY_US(1000);//tick base is 1 ms
1945*53ee8cc1Swenshuai.xi       d_cnt+=1;
1946*53ee8cc1Swenshuai.xi     }
1947*53ee8cc1Swenshuai.xi   }
1948*53ee8cc1Swenshuai.xi 
1949*53ee8cc1Swenshuai.xi   if (d_cnt > (U32) 3000)
1950*53ee8cc1Swenshuai.xi   {
1951*53ee8cc1Swenshuai.xi      diag_printf("hcd_unlink_urb timeout\n");
1952*53ee8cc1Swenshuai.xi      // TODO: Review the flow
1953*53ee8cc1Swenshuai.xi      diag_printf("Reset USB HW\n");
1954*53ee8cc1Swenshuai.xi      USB_HW_Reset(hcd);
1955*53ee8cc1Swenshuai.xi      //USB_HW_Reset((struct usb_hcd*) urb->dev->bus->hcpriv, urb->dev);
1956*53ee8cc1Swenshuai.xi         return -ETIMEDOUT;
1957*53ee8cc1Swenshuai.xi   }
1958*53ee8cc1Swenshuai.xi   return 0;
1959*53ee8cc1Swenshuai.xi 
1960*53ee8cc1Swenshuai.xi done:
1961*53ee8cc1Swenshuai.xi   spin_unlock (&hcd_data_lock);
1962*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&urb->lock, flags);
1963*53ee8cc1Swenshuai.xi bye:
1964*53ee8cc1Swenshuai.xi   if (retval && sys && sys->driver)
1965*53ee8cc1Swenshuai.xi     dev_dbg (sys, "hcd_unlink_urb %p fail %d\n", urb, retval);
1966*53ee8cc1Swenshuai.xi   return retval;
1967*53ee8cc1Swenshuai.xi }
1968*53ee8cc1Swenshuai.xi 
1969*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
hcd_endpoint_disable(struct usb_device * udev,int endpoint)1970*53ee8cc1Swenshuai.xi static void hcd_endpoint_disable (struct usb_device *udev, int endpoint)
1971*53ee8cc1Swenshuai.xi {
1972*53ee8cc1Swenshuai.xi   struct list_head *__mptr;
1973*53ee8cc1Swenshuai.xi   struct hcd_dev  *dev;
1974*53ee8cc1Swenshuai.xi   struct usb_hcd  *hcd;
1975*53ee8cc1Swenshuai.xi   struct urb  *urb;
1976*53ee8cc1Swenshuai.xi   char s[10];
1977*53ee8cc1Swenshuai.xi   U32  epnum = endpoint & USB_ENDPOINT_NUMBER_MASK;
1978*53ee8cc1Swenshuai.xi 
1979*53ee8cc1Swenshuai.xi   dev = (struct hcd_dev*) udev->hcpriv;
1980*53ee8cc1Swenshuai.xi   hcd = (struct usb_hcd*) udev->bus->hcpriv;
1981*53ee8cc1Swenshuai.xi 
1982*53ee8cc1Swenshuai.xi   local_irq_disable ();
1983*53ee8cc1Swenshuai.xi 
1984*53ee8cc1Swenshuai.xi hcd_rescan:
1985*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1986*53ee8cc1Swenshuai.xi   if (endpoint & USB_DIR_IN) {
1987*53ee8cc1Swenshuai.xi     usb_endpoint_halt (udev, epnum, 0);
1988*53ee8cc1Swenshuai.xi     udev->epmaxpacketin [epnum] = 0;
1989*53ee8cc1Swenshuai.xi   } else {
1990*53ee8cc1Swenshuai.xi     usb_endpoint_halt (udev, epnum, 1);
1991*53ee8cc1Swenshuai.xi     udev->epmaxpacketout [epnum] = 0;
1992*53ee8cc1Swenshuai.xi   }
1993*53ee8cc1Swenshuai.xi 
1994*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1995*53ee8cc1Swenshuai.xi   spin_lock (&hcd_data_lock);
1996*53ee8cc1Swenshuai.xi 
1997*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
1998*53ee8cc1Swenshuai.xi 
1999*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2000*53ee8cc1Swenshuai.xi   urb = list_entry((&dev->urb_list)->next, struct urb, urb_list);
2001*53ee8cc1Swenshuai.xi   for( ; &(urb->urb_list) != &(dev->urb_list);
2002*53ee8cc1Swenshuai.xi     __mptr = urb->urb_list.next,
2003*53ee8cc1Swenshuai.xi     urb = (struct urb *)( (char *)__mptr - (char *)offsetof(struct urb,urb_list) )
2004*53ee8cc1Swenshuai.xi   )
2005*53ee8cc1Swenshuai.xi   {
2006*53ee8cc1Swenshuai.xi     int  tmp = urb->pipe;
2007*53ee8cc1Swenshuai.xi 
2008*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2009*53ee8cc1Swenshuai.xi     if ((U32)usb_pipeendpoint (tmp) != epnum)
2010*53ee8cc1Swenshuai.xi       continue;
2011*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2012*53ee8cc1Swenshuai.xi     if (epnum != 0 && ((tmp ^ endpoint) & USB_DIR_IN))
2013*53ee8cc1Swenshuai.xi       continue;
2014*53ee8cc1Swenshuai.xi 
2015*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2016*53ee8cc1Swenshuai.xi     if (urb->status != -EINPROGRESS)
2017*53ee8cc1Swenshuai.xi       continue;
2018*53ee8cc1Swenshuai.xi     usb_get_urb (urb);
2019*53ee8cc1Swenshuai.xi     spin_unlock (&hcd_data_lock);
2020*53ee8cc1Swenshuai.xi 
2021*53ee8cc1Swenshuai.xi     spin_lock (&urb->lock);
2022*53ee8cc1Swenshuai.xi     tmp = urb->status;
2023*53ee8cc1Swenshuai.xi     if (tmp == -EINPROGRESS)
2024*53ee8cc1Swenshuai.xi     {
2025*53ee8cc1Swenshuai.xi       diag_printf("hcd_endpoint_disable return ESHUTDOWN !!!\n");
2026*53ee8cc1Swenshuai.xi       urb->status = -ESHUTDOWN;
2027*53ee8cc1Swenshuai.xi     }
2028*53ee8cc1Swenshuai.xi     spin_unlock (&urb->lock);
2029*53ee8cc1Swenshuai.xi 
2030*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2031*53ee8cc1Swenshuai.xi     if (tmp == -EINPROGRESS) {
2032*53ee8cc1Swenshuai.xi       tmp = urb->pipe;
2033*53ee8cc1Swenshuai.xi       unlink1 (hcd, urb);
2034*53ee8cc1Swenshuai.xi       switch (usb_pipetype (tmp)) {
2035*53ee8cc1Swenshuai.xi          case PIPE_CONTROL:
2036*53ee8cc1Swenshuai.xi           strncpy(s,"", 1);
2037*53ee8cc1Swenshuai.xi           break;
2038*53ee8cc1Swenshuai.xi          case PIPE_BULK:
2039*53ee8cc1Swenshuai.xi           strncpy(s,"-bulk", strlen("-bulk"));
2040*53ee8cc1Swenshuai.xi           break;
2041*53ee8cc1Swenshuai.xi          case PIPE_INTERRUPT:
2042*53ee8cc1Swenshuai.xi           strncpy(s,"-intr", strlen("-intr"));
2043*53ee8cc1Swenshuai.xi           break;
2044*53ee8cc1Swenshuai.xi          default:
2045*53ee8cc1Swenshuai.xi           strncpy(s,"-iso", strlen("-iso"));
2046*53ee8cc1Swenshuai.xi           break;
2047*53ee8cc1Swenshuai.xi       }
2048*53ee8cc1Swenshuai.xi 
2049*53ee8cc1Swenshuai.xi       dev_dbg (hcd->controller,
2050*53ee8cc1Swenshuai.xi         "shutdown urb %p pipe %08x ep%d%s%s\n",
2051*53ee8cc1Swenshuai.xi         urb, tmp, usb_pipeendpoint (tmp),
2052*53ee8cc1Swenshuai.xi         (tmp & USB_DIR_IN) ? "in" : "out",
2053*53ee8cc1Swenshuai.xi          s);
2054*53ee8cc1Swenshuai.xi     }
2055*53ee8cc1Swenshuai.xi     usb_put_urb (urb);
2056*53ee8cc1Swenshuai.xi 
2057*53ee8cc1Swenshuai.xi     /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2058*53ee8cc1Swenshuai.xi     goto hcd_rescan;
2059*53ee8cc1Swenshuai.xi   }
2060*53ee8cc1Swenshuai.xi   spin_unlock (&hcd_data_lock);
2061*53ee8cc1Swenshuai.xi   local_irq_enable();
2062*53ee8cc1Swenshuai.xi 
2063*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2064*53ee8cc1Swenshuai.xi   //might_sleep ();
2065*53ee8cc1Swenshuai.xi   if (hcd->driver->endpoint_disable)
2066*53ee8cc1Swenshuai.xi     hcd->driver->endpoint_disable (hcd, dev, endpoint);
2067*53ee8cc1Swenshuai.xi }
2068*53ee8cc1Swenshuai.xi 
2069*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
2070*53ee8cc1Swenshuai.xi 
2071*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2072*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2073*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2074*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2075*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2076*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2077*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2078*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2079*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2080*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2081*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2082*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2083*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2084*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2085*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2086*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2087*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2088*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2089*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2090*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2091*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
hcd_free_dev(struct usb_device * udev)2092*53ee8cc1Swenshuai.xi static int hcd_free_dev (struct usb_device *udev)
2093*53ee8cc1Swenshuai.xi {
2094*53ee8cc1Swenshuai.xi   struct hcd_dev    *dev;
2095*53ee8cc1Swenshuai.xi   struct usb_hcd    *hcd;
2096*53ee8cc1Swenshuai.xi   U32    flags;
2097*53ee8cc1Swenshuai.xi 
2098*53ee8cc1Swenshuai.xi   if (!udev || !udev->hcpriv)
2099*53ee8cc1Swenshuai.xi     return -EINVAL;
2100*53ee8cc1Swenshuai.xi 
2101*53ee8cc1Swenshuai.xi   if (!udev->bus || !udev->bus->hcpriv)
2102*53ee8cc1Swenshuai.xi     return -ENODEV;
2103*53ee8cc1Swenshuai.xi 
2104*53ee8cc1Swenshuai.xi   // should udev->devnum == -1 ??
2105*53ee8cc1Swenshuai.xi 
2106*53ee8cc1Swenshuai.xi   dev = (struct hcd_dev*) udev->hcpriv;
2107*53ee8cc1Swenshuai.xi   hcd = (struct usb_hcd*) udev->bus->hcpriv;
2108*53ee8cc1Swenshuai.xi 
2109*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2110*53ee8cc1Swenshuai.xi   if (!list_empty (&dev->urb_list)) {
2111*53ee8cc1Swenshuai.xi     dev_dbg (hcd->controller, "free busy dev, %s devnum %d (bug!)\n",
2112*53ee8cc1Swenshuai.xi       hcd->self.bus_name, udev->devnum);
2113*53ee8cc1Swenshuai.xi     return -EINVAL;
2114*53ee8cc1Swenshuai.xi   }
2115*53ee8cc1Swenshuai.xi 
2116*53ee8cc1Swenshuai.xi   spin_lock_irqsave (&hcd_data_lock, flags);
2117*53ee8cc1Swenshuai.xi   list_del (&dev->dev_list);
2118*53ee8cc1Swenshuai.xi   udev->hcpriv = NULL;
2119*53ee8cc1Swenshuai.xi   spin_unlock_irqrestore (&hcd_data_lock, flags);
2120*53ee8cc1Swenshuai.xi 
2121*53ee8cc1Swenshuai.xi   kfree (dev);
2122*53ee8cc1Swenshuai.xi   return 0;
2123*53ee8cc1Swenshuai.xi }
2124*53ee8cc1Swenshuai.xi 
2125*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2126*53ee8cc1Swenshuai.xi 
2127*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2128*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2129*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2130*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2131*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2132*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2133*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2134*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2135*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2136*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2137*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2138*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2139*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2140*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2141*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2142*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2143*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2144*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2145*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2146*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2147*53ee8cc1Swenshuai.xi struct usb_operations usb_hcd_operations = {
2148*53ee8cc1Swenshuai.xi   hcd_alloc_dev,
2149*53ee8cc1Swenshuai.xi   hcd_free_dev,
2150*53ee8cc1Swenshuai.xi   hcd_get_frame_number,
2151*53ee8cc1Swenshuai.xi   hcd_submit_urb,
2152*53ee8cc1Swenshuai.xi   hcd_unlink_urb,
2153*53ee8cc1Swenshuai.xi   hcd_buffer_alloc,
2154*53ee8cc1Swenshuai.xi   hcd_buffer_free,
2155*53ee8cc1Swenshuai.xi   hcd_endpoint_disable,
2156*53ee8cc1Swenshuai.xi };
2157*53ee8cc1Swenshuai.xi 
2158*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
2159*53ee8cc1Swenshuai.xi 
2160*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
usb_hcd_giveback_urb(struct usb_hcd * hcd,struct urb * urb,struct pt_regs * regs)2161*53ee8cc1Swenshuai.xi void usb_hcd_giveback_urb (struct usb_hcd *hcd, struct urb *urb, struct pt_regs *regs)
2162*53ee8cc1Swenshuai.xi {
2163*53ee8cc1Swenshuai.xi   urb_unlink (urb);
2164*53ee8cc1Swenshuai.xi   urb->complete (urb, regs);
2165*53ee8cc1Swenshuai.xi   usb_put_urb (urb);
2166*53ee8cc1Swenshuai.xi }
2167*53ee8cc1Swenshuai.xi 
2168*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
2169*53ee8cc1Swenshuai.xi 
2170*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2171*53ee8cc1Swenshuai.xi  #if 0
2172*53ee8cc1Swenshuai.xi irqreturn_t usb_hcd_irq (int irq, void *__hcd, struct pt_regs * r)
2173*53ee8cc1Swenshuai.xi {
2174*53ee8cc1Swenshuai.xi   struct usb_hcd    *hcd = (struct usb_hcd*) __hcd;
2175*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2176*53ee8cc1Swenshuai.xi   hcd->driver->irq (hcd, r,0);
2177*53ee8cc1Swenshuai.xi }
2178*53ee8cc1Swenshuai.xi #endif
2179*53ee8cc1Swenshuai.xi /*-------------------------------------------------------------------------*/
2180*53ee8cc1Swenshuai.xi 
2181*53ee8cc1Swenshuai.xi #if 0
2182*53ee8cc1Swenshuai.xi static void hcd_panic (void *_hcd)
2183*53ee8cc1Swenshuai.xi {
2184*53ee8cc1Swenshuai.xi   struct usb_hcd    *hcd = (struct usb_hcd*) _hcd;
2185*53ee8cc1Swenshuai.xi   struct usb_device  *hub = (struct usb_device*) hcd->self.root_hub;
2186*53ee8cc1Swenshuai.xi   U32    i;
2187*53ee8cc1Swenshuai.xi 
2188*53ee8cc1Swenshuai.xi   /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2189*53ee8cc1Swenshuai.xi   hub->state = USB_STATE_NOTATTACHED;
2190*53ee8cc1Swenshuai.xi   for (i = 0; i < (U32) hub->maxchild; i++) {
2191*53ee8cc1Swenshuai.xi     if (hub->children [i])
2192*53ee8cc1Swenshuai.xi       usb_disconnect (&hub->children [i]);
2193*53ee8cc1Swenshuai.xi   }
2194*53ee8cc1Swenshuai.xi 
2195*53ee8cc1Swenshuai.xi }
2196*53ee8cc1Swenshuai.xi #endif
2197*53ee8cc1Swenshuai.xi 
2198*53ee8cc1Swenshuai.xi #endif    //#ifdef
2199*53ee8cc1Swenshuai.xi 
2200*53ee8cc1Swenshuai.xi #ifdef CONFIG_OTG
2201*53ee8cc1Swenshuai.xi 
usb_otgd_irq(int irq,void * __otgd,struct pt_regs * r)2202*53ee8cc1Swenshuai.xi irqreturn_t usb_otgd_irq (int irq, void *__otgd, struct pt_regs * r)
2203*53ee8cc1Swenshuai.xi {
2204*53ee8cc1Swenshuai.xi   struct usb_otgd    *otgd = (struct usb_otgd*) __otgd;
2205*53ee8cc1Swenshuai.xi   otgd->driver->irq (otgd, r);
2206*53ee8cc1Swenshuai.xi }
2207*53ee8cc1Swenshuai.xi 
2208*53ee8cc1Swenshuai.xi /*USB HOST USB HOST USB HOST USB HOST USB HOST USB HOST*/
2209*53ee8cc1Swenshuai.xi 
usb_register_otg_to_bus(struct usb_otgd * otgd,struct device * hc)2210*53ee8cc1Swenshuai.xi int usb_register_otg_to_bus(struct usb_otgd *otgd, struct device *hc)
2211*53ee8cc1Swenshuai.xi {
2212*53ee8cc1Swenshuai.xi   struct list_head *buslist;
2213*53ee8cc1Swenshuai.xi   struct usb_bus *bus;
2214*53ee8cc1Swenshuai.xi 
2215*53ee8cc1Swenshuai.xi   for (buslist = usb_bus_list.next;
2216*53ee8cc1Swenshuai.xi        buslist != &usb_bus_list;
2217*53ee8cc1Swenshuai.xi        buslist = buslist->next) {
2218*53ee8cc1Swenshuai.xi     const struct list_head *mptr = buslist;
2219*53ee8cc1Swenshuai.xi     bus = (struct usb_bus *)( (char *)mptr - offsetof( struct usb_bus, bus_list) );
2220*53ee8cc1Swenshuai.xi     if ( bus->controller == hc )
2221*53ee8cc1Swenshuai.xi     {
2222*53ee8cc1Swenshuai.xi       bus->otgpriv = otgd;
2223*53ee8cc1Swenshuai.xi       otgd->bus = bus;
2224*53ee8cc1Swenshuai.xi       dbg("Found bus (%p), device name is %s",bus,bus->controller->name);
2225*53ee8cc1Swenshuai.xi       return 0;
2226*53ee8cc1Swenshuai.xi     }
2227*53ee8cc1Swenshuai.xi   }
2228*53ee8cc1Swenshuai.xi   return -ENODEV;
2229*53ee8cc1Swenshuai.xi }
2230*53ee8cc1Swenshuai.xi 
2231*53ee8cc1Swenshuai.xi 
2232*53ee8cc1Swenshuai.xi #endif
2233*53ee8cc1Swenshuai.xi 
2234*53ee8cc1Swenshuai.xi 
2235