xref: /utopia/UTPA2-700.0.x/modules/usb/drv/usb_ecos/newhost/drvPipe.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 //#include <MsCommon.h> // NUSED
80*53ee8cc1Swenshuai.xi 
81*53ee8cc1Swenshuai.xi //#include "include/drvConfig.h" // NUSED
82*53ee8cc1Swenshuai.xi //#include "include/drvCompiler.h" // NUSED
83*53ee8cc1Swenshuai.xi //#include "include/drvErrno.h" // NUSED
84*53ee8cc1Swenshuai.xi //#include "include/drvPorts.h" // NUSED
85*53ee8cc1Swenshuai.xi //#include "include/drvTimer.h" // NUSED
86*53ee8cc1Swenshuai.xi //#include "include/drvList.h" // NUSED
87*53ee8cc1Swenshuai.xi //#include "include/drvKernel.h" // NUSED
88*53ee8cc1Swenshuai.xi 
89*53ee8cc1Swenshuai.xi // USB related header files
90*53ee8cc1Swenshuai.xi //#include "include/drvUSBHost.h" // NUSED
91*53ee8cc1Swenshuai.xi #include "drvUsbd.h"
92*53ee8cc1Swenshuai.xi 
93*53ee8cc1Swenshuai.xi /**
94*53ee8cc1Swenshuai.xi      * @brief           create new urb
95*53ee8cc1Swenshuai.xi      *
96*53ee8cc1Swenshuai.xi      * @param           int iso_packets
97*53ee8cc1Swenshuai.xi      * @param           int mem_flags
98*53ee8cc1Swenshuai.xi      *
99*53ee8cc1Swenshuai.xi      * @return          allocated urb
100*53ee8cc1Swenshuai.xi      */
ms_usb_alloc_urb(int mem_flags)101*53ee8cc1Swenshuai.xi struct urb *ms_usb_alloc_urb(int mem_flags)
102*53ee8cc1Swenshuai.xi {
103*53ee8cc1Swenshuai.xi     struct urb *ms_urb;
104*53ee8cc1Swenshuai.xi 
105*53ee8cc1Swenshuai.xi     ms_urb = (struct urb *)kmalloc(sizeof(struct urb), mem_flags);
106*53ee8cc1Swenshuai.xi     if (!ms_urb)
107*53ee8cc1Swenshuai.xi     {
108*53ee8cc1Swenshuai.xi         ms_usbhost_err("alloc_urb: kmalloc failed%s","\n");
109*53ee8cc1Swenshuai.xi         return NULL;
110*53ee8cc1Swenshuai.xi     }
111*53ee8cc1Swenshuai.xi     memset(ms_urb, 0, sizeof(*ms_urb));
112*53ee8cc1Swenshuai.xi     ms_urb->count = (atomic_t)osapi_ATOMIC_INIT(1);
113*53ee8cc1Swenshuai.xi     osapi_spin_lock_init(&ms_urb->lock);
114*53ee8cc1Swenshuai.xi     return ms_urb;
115*53ee8cc1Swenshuai.xi }
116*53ee8cc1Swenshuai.xi 
117*53ee8cc1Swenshuai.xi /**
118*53ee8cc1Swenshuai.xi      * @brief           test urb reference count and free the memory
119*53ee8cc1Swenshuai.xi      *
120*53ee8cc1Swenshuai.xi      * @param           struct urb *ms_urb
121*53ee8cc1Swenshuai.xi      *
122*53ee8cc1Swenshuai.xi      * @return          none
123*53ee8cc1Swenshuai.xi      */
ms_usb_free_urb(struct urb * ms_urb)124*53ee8cc1Swenshuai.xi void ms_usb_free_urb(struct urb *ms_urb)
125*53ee8cc1Swenshuai.xi {
126*53ee8cc1Swenshuai.xi     if (ms_urb)
127*53ee8cc1Swenshuai.xi         if (osapi_atomic_dec_and_test(&ms_urb->count))
128*53ee8cc1Swenshuai.xi             kfree(ms_urb);
129*53ee8cc1Swenshuai.xi }
130*53ee8cc1Swenshuai.xi 
131*53ee8cc1Swenshuai.xi /**
132*53ee8cc1Swenshuai.xi      * @brief           increase urb reference count
133*53ee8cc1Swenshuai.xi      *
134*53ee8cc1Swenshuai.xi      * @param           struct urb *urb
135*53ee8cc1Swenshuai.xi      *
136*53ee8cc1Swenshuai.xi      * @return          current urb
137*53ee8cc1Swenshuai.xi      */
ms_usb_get_urb(struct urb * ms_urb)138*53ee8cc1Swenshuai.xi struct urb * ms_usb_get_urb(struct urb *ms_urb)
139*53ee8cc1Swenshuai.xi {
140*53ee8cc1Swenshuai.xi     if (ms_urb)
141*53ee8cc1Swenshuai.xi     {
142*53ee8cc1Swenshuai.xi         osapi_atomic_inc(&ms_urb->count);
143*53ee8cc1Swenshuai.xi         return ms_urb;
144*53ee8cc1Swenshuai.xi     }
145*53ee8cc1Swenshuai.xi     else
146*53ee8cc1Swenshuai.xi         return NULL;
147*53ee8cc1Swenshuai.xi }
148*53ee8cc1Swenshuai.xi 
149*53ee8cc1Swenshuai.xi /**
150*53ee8cc1Swenshuai.xi      * @brief           submit urb to the queue
151*53ee8cc1Swenshuai.xi      *
152*53ee8cc1Swenshuai.xi      * @param           struct urb *ms_urb
153*53ee8cc1Swenshuai.xi      * @param           int mem_flags
154*53ee8cc1Swenshuai.xi      *
155*53ee8cc1Swenshuai.xi      * @return          error code
156*53ee8cc1Swenshuai.xi      */
ms_usb_submit_urb(struct urb * ms_urb,int mem_flags)157*53ee8cc1Swenshuai.xi int ms_usb_submit_urb(struct urb *ms_urb, int mem_flags)
158*53ee8cc1Swenshuai.xi {
159*53ee8cc1Swenshuai.xi     int ms_pipe, temp_p, max_p;
160*53ee8cc1Swenshuai.xi     struct usb_device  *pUdev;
161*53ee8cc1Swenshuai.xi     //struct ms_usb_bus_ops  *usb_op;
162*53ee8cc1Swenshuai.xi     int      is_out;
163*53ee8cc1Swenshuai.xi 
164*53ee8cc1Swenshuai.xi     if (!ms_urb || ms_urb->hcpriv || !ms_urb->complete_func)
165*53ee8cc1Swenshuai.xi         return -EINVAL;
166*53ee8cc1Swenshuai.xi     if (!(pUdev = ms_urb->dev) || (pUdev->eState < USB_STATE_DEFAULT) ||
167*53ee8cc1Swenshuai.xi         (!pUdev->bus) || (pUdev->u32DevNum <= 0))
168*53ee8cc1Swenshuai.xi         return -ENODEV;
169*53ee8cc1Swenshuai.xi     //if (!(usb_op = pUdev->bus->bus_ops) || !usb_op->ms_hcd_submit_urb)
170*53ee8cc1Swenshuai.xi     //    return -ENODEV;
171*53ee8cc1Swenshuai.xi 
172*53ee8cc1Swenshuai.xi     ms_urb->s32Status = -EINPROGRESS;
173*53ee8cc1Swenshuai.xi     ms_urb->u32ActualLength = 0;
174*53ee8cc1Swenshuai.xi 
175*53ee8cc1Swenshuai.xi     ms_pipe = ms_urb->u32Pipe;
176*53ee8cc1Swenshuai.xi     temp_p = usb_pipetype (ms_pipe);
177*53ee8cc1Swenshuai.xi     is_out = usb_pipeout (ms_pipe);
178*53ee8cc1Swenshuai.xi 
179*53ee8cc1Swenshuai.xi     if (!usb_pipecontrol (ms_pipe) && pUdev->eState < USB_STATE_CONFIGURED)
180*53ee8cc1Swenshuai.xi         return -ENODEV;
181*53ee8cc1Swenshuai.xi 
182*53ee8cc1Swenshuai.xi     /* patch from linux, obsolete code */
183*53ee8cc1Swenshuai.xi     //if (usb_endpoint_halted (pUdev, usb_pipeendpoint (ms_pipe), is_out))
184*53ee8cc1Swenshuai.xi     //    return -EPIPE;
185*53ee8cc1Swenshuai.xi 
186*53ee8cc1Swenshuai.xi     max_p = usb_maxpacket (pUdev, ms_pipe, is_out);
187*53ee8cc1Swenshuai.xi     if (max_p <= 0)
188*53ee8cc1Swenshuai.xi     {
189*53ee8cc1Swenshuai.xi         ms_usbhost_err ("<%s> wrong endpoint %d-%s on usb-%s-%s (bad maxpacket %d)",
190*53ee8cc1Swenshuai.xi             __FUNCTION__,
191*53ee8cc1Swenshuai.xi             usb_pipeendpoint (ms_pipe), is_out ? "OUT" : "IN",
192*53ee8cc1Swenshuai.xi             pUdev->bus->bus_name, pUdev->devpath,
193*53ee8cc1Swenshuai.xi             max_p);
194*53ee8cc1Swenshuai.xi         return -EMSGSIZE;
195*53ee8cc1Swenshuai.xi     }
196*53ee8cc1Swenshuai.xi 
197*53ee8cc1Swenshuai.xi     if (ms_urb->u32TransferBufferLength < 0)
198*53ee8cc1Swenshuai.xi         return -EMSGSIZE;
199*53ee8cc1Swenshuai.xi 
200*53ee8cc1Swenshuai.xi     //only support interrupt pipe
201*53ee8cc1Swenshuai.xi     if (temp_p == EP_INTERRUPT)
202*53ee8cc1Swenshuai.xi     {
203*53ee8cc1Swenshuai.xi             if (ms_urb->u32Interval <= 0)
204*53ee8cc1Swenshuai.xi                 return -EINVAL;
205*53ee8cc1Swenshuai.xi             switch (pUdev->eSpeed)
206*53ee8cc1Swenshuai.xi             {
207*53ee8cc1Swenshuai.xi                 case USB_HIGH_SPEED:  /* units are microframes */
208*53ee8cc1Swenshuai.xi                     // NOTE usb handles 2^15
209*53ee8cc1Swenshuai.xi                     if (ms_urb->u32Interval > (1024 * 8))
210*53ee8cc1Swenshuai.xi                         ms_urb->u32Interval = 1024 * 8;
211*53ee8cc1Swenshuai.xi                     temp_p = 1024 * 8;
212*53ee8cc1Swenshuai.xi                     break;
213*53ee8cc1Swenshuai.xi                 case USB_FULL_SPEED:  /* units are frames/msec */
214*53ee8cc1Swenshuai.xi                 case USB_LOW_SPEED:
215*53ee8cc1Swenshuai.xi                     {
216*53ee8cc1Swenshuai.xi                         if (ms_urb->u32Interval > 255)
217*53ee8cc1Swenshuai.xi                             return -EINVAL;
218*53ee8cc1Swenshuai.xi                         // NOTE ohci only handles up to 32
219*53ee8cc1Swenshuai.xi                         temp_p = 128;
220*53ee8cc1Swenshuai.xi                     }
221*53ee8cc1Swenshuai.xi                     break;
222*53ee8cc1Swenshuai.xi                 default:
223*53ee8cc1Swenshuai.xi                     return -EINVAL;
224*53ee8cc1Swenshuai.xi             }
225*53ee8cc1Swenshuai.xi             while (temp_p > ms_urb->u32Interval)
226*53ee8cc1Swenshuai.xi                 temp_p >>= 1;
227*53ee8cc1Swenshuai.xi             ms_urb->u32Interval = temp_p;
228*53ee8cc1Swenshuai.xi     }
229*53ee8cc1Swenshuai.xi 
230*53ee8cc1Swenshuai.xi     //return usb_op->ms_hcd_submit_urb (ms_urb, mem_flags);
231*53ee8cc1Swenshuai.xi     return ms_hcd_submit_urb (ms_urb, mem_flags);
232*53ee8cc1Swenshuai.xi }
233*53ee8cc1Swenshuai.xi 
234*53ee8cc1Swenshuai.xi /**
235*53ee8cc1Swenshuai.xi      * @brief           unlink urb from the queue
236*53ee8cc1Swenshuai.xi      *
237*53ee8cc1Swenshuai.xi      * @param           struct urb *ms_urb
238*53ee8cc1Swenshuai.xi      *
239*53ee8cc1Swenshuai.xi      * @return          error code
240*53ee8cc1Swenshuai.xi      */
ms_usb_unlink_urb(struct urb * ms_urb)241*53ee8cc1Swenshuai.xi int ms_usb_unlink_urb(struct urb *ms_urb)
242*53ee8cc1Swenshuai.xi {
243*53ee8cc1Swenshuai.xi     //if (ms_urb && ms_urb->dev && ms_urb->dev->bus && ms_urb->dev->bus->bus_ops)
244*53ee8cc1Swenshuai.xi     //    return ms_urb->dev->bus->bus_ops->ms_hcd_unlink_urb(ms_urb);
245*53ee8cc1Swenshuai.xi     //else
246*53ee8cc1Swenshuai.xi     //    return -ENODEV;
247*53ee8cc1Swenshuai.xi     if (!ms_urb)
248*53ee8cc1Swenshuai.xi         return -EINVAL;
249*53ee8cc1Swenshuai.xi     if (!ms_urb->dev)
250*53ee8cc1Swenshuai.xi         return -ENODEV;
251*53ee8cc1Swenshuai.xi     return ms_hcd_unlink_urb(ms_urb, -ECONNRESET);
252*53ee8cc1Swenshuai.xi }
253