1 //<MStar Software>
2 //******************************************************************************
3 // MStar Software
4 // Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
5 // All software, firmware and related documentation herein ("MStar Software") are
6 // intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
7 // law, including, but not limited to, copyright law and international treaties.
8 // Any use, modification, reproduction, retransmission, or republication of all
9 // or part of MStar Software is expressly prohibited, unless prior written
10 // permission has been granted by MStar.
11 //
12 // By accessing, browsing and/or using MStar Software, you acknowledge that you
13 // have read, understood, and agree, to be bound by below terms ("Terms") and to
14 // comply with all applicable laws and regulations:
15 //
16 // 1. MStar shall retain any and all right, ownership and interest to MStar
17 // Software and any modification/derivatives thereof.
18 // No right, ownership, or interest to MStar Software and any
19 // modification/derivatives thereof is transferred to you under Terms.
20 //
21 // 2. You understand that MStar Software might include, incorporate or be
22 // supplied together with third party`s software and the use of MStar
23 // Software may require additional licenses from third parties.
24 // Therefore, you hereby agree it is your sole responsibility to separately
25 // obtain any and all third party right and license necessary for your use of
26 // such third party`s software.
27 //
28 // 3. MStar Software and any modification/derivatives thereof shall be deemed as
29 // MStar`s confidential information and you agree to keep MStar`s
30 // confidential information in strictest confidence and not disclose to any
31 // third party.
32 //
33 // 4. MStar Software is provided on an "AS IS" basis without warranties of any
34 // kind. Any warranties are hereby expressly disclaimed by MStar, including
35 // without limitation, any warranties of merchantability, non-infringement of
36 // intellectual property rights, fitness for a particular purpose, error free
37 // and in conformity with any international standard. You agree to waive any
38 // claim against MStar for any loss, damage, cost or expense that you may
39 // incur related to your use of MStar Software.
40 // In no event shall MStar be liable for any direct, indirect, incidental or
41 // consequential damages, including without limitation, lost of profit or
42 // revenues, lost or damage of data, and unauthorized system use.
43 // You agree that this Section 4 shall still apply without being affected
44 // even if MStar Software has been modified by MStar in accordance with your
45 // request or instruction for your use, except otherwise agreed by both
46 // parties in writing.
47 //
48 // 5. If requested, MStar may from time to time provide technical supports or
49 // services in relation with MStar Software to you for your use of
50 // MStar Software in conjunction with your or your customer`s product
51 // ("Services").
52 // You understand and agree that, except otherwise agreed by both parties in
53 // writing, Services are provided on an "AS IS" basis and the warranty
54 // disclaimer set forth in Section 4 above shall apply.
55 //
56 // 6. Nothing contained herein shall be construed as by implication, estoppels
57 // or otherwise:
58 // (a) conferring any license or right to use MStar name, trademark, service
59 // mark, symbol or any other identification;
60 // (b) obligating MStar or any of its affiliates to furnish any person,
61 // including without limitation, you and your customers, any assistance
62 // of any kind whatsoever, or any information; or
63 // (c) conferring any license or right under any intellectual property right.
64 //
65 // 7. These terms shall be governed by and construed in accordance with the laws
66 // of Taiwan, R.O.C., excluding its conflict of law rules.
67 // Any and all dispute arising out hereof or related hereto shall be finally
68 // settled by arbitration referred to the Chinese Arbitration Association,
69 // Taipei in accordance with the ROC Arbitration Law and the Arbitration
70 // Rules of the Association by three (3) arbitrators appointed in accordance
71 // with the said Rules.
72 // The place of arbitration shall be in Taipei, Taiwan and the language shall
73 // be English.
74 // The arbitration award shall be final and binding to both parties.
75 //
76 //******************************************************************************
77 //<MStar Software>
78
79 //#include <MsCommon.h> // NUSED
80 //#include <cyg/hal/hal_if.h> // NUSED
81 #include "include/drvKernel.h"
82 //#include "include/drvTimer.h" // NUSED
83 //#include "include/drvPorts.h" // NUSED
84 //#include "include/drvCPE_AMBA.h" // NUSED
85
86 extern int ms_usb_core_init(void);
87 extern int ms_usb_core_uninit(void);
88 extern struct ms_bus_type usb_bus_type;
89 extern S32 usb_bus_list_lock;
90 extern void init_cache_memory(void);
91
92 // The previous code has serious bug. Removed. Jonas_20110519
93 // The following code has been rewitten by Jonas_20110519
94 #define BITOP_WORD(nr) ((nr) / BITS_PER_LONG)
95 /**
96 * @brief find out the position of the next zero
97 *
98 * @param U32 *addr
99 * @param U32 size
100 * @param U32 offset
101 *
102 * @return zero bit position
103 */
find_next_zero_bit(const U32 * addr,U32 size,U32 offset)104 U32 find_next_zero_bit(const U32 *addr, U32 size, U32 offset)
105 {
106 const U32 *p = addr + BITOP_WORD(offset);
107 U32 ms_result = offset & ~(BITS_PER_LONG-1);
108 U32 ms_tmp;
109
110 if (offset >= size)
111 return size;
112 size -= ms_result;
113 offset %= BITS_PER_LONG;
114 if (offset)
115 {
116 ms_tmp = *(p++);
117 ms_tmp |= ~0UL >> (BITS_PER_LONG - offset);
118 if (size < BITS_PER_LONG)
119 goto ms_found_first;
120 if (~ms_tmp)
121 goto ms_found_middle;
122 size -= BITS_PER_LONG;
123 ms_result += BITS_PER_LONG;
124 }
125 while (size & ~(BITS_PER_LONG-1))
126 {
127 if (~(ms_tmp = *(p++)))
128 goto ms_found_middle;
129 ms_result += BITS_PER_LONG;
130 size -= BITS_PER_LONG;
131 }
132 if (!size)
133 return ms_result;
134 ms_tmp = *p;
135
136 ms_found_first:
137 ms_tmp |= ~0UL << size;
138 if (ms_tmp == ~0UL)
139 return ms_result + size;
140 ms_found_middle:
141 return ms_result + ms_find_1st_zero(ms_tmp);
142 }
143
144 /**
145 * @brief find out the position of the next zero
146 *
147 * @param U32 *addr
148 * @param U32 size
149 * @param U32 offset
150 *
151 * @return zero bit position
152 */
find_next_zero_bit_le(U32 * addr,U32 size,U32 offset)153 U32 find_next_zero_bit_le(U32 *addr, U32 size, U32 offset)
154 {
155 return find_next_zero_bit(addr, size, offset);
156 }
157
158 #ifndef HAL_DELAY_US
159 externC void hal_delay_us(int us);
160 #define HAL_DELAY_US(n) hal_delay_us(n)
161 #endif
162 /**
163 * @brief wait for N us
164 *
165 * @param U32 us
166 *
167 * @return none
168 */
udelay(U32 us)169 inline void udelay(U32 us)
170 {
171 HAL_DELAY_US(us);
172 }
173
174 /**
175 * @brief initial USB system
176 *
177 * @param none
178 *
179 * @return none
180 */
ms_init_sys(void)181 void ms_init_sys(void)
182 {
183 init_cache_memory();
184 osapi_mutex_init(usb_bus_list_lock, "USB_BUS_MUTEX");
185 ms_list_init(&usb_bus_type.devices_list);
186 ms_list_init(&usb_bus_type.drivers_list);
187
188 //sti();
189
190 // Init timer and init software timer link list
191 ms_init_timers();
192
193 // Init USB core (including hub)
194 ms_usb_core_init();
195 }
196
ms_exit_sys(void)197 void ms_exit_sys(void)
198 {
199 ms_usb_core_uninit();
200 ms_remove_timers();
201
202 //cli();
203 osapi_mutex_delete(usb_bus_list_lock);
204 destroy_NC_mem();
205 }
206
207 /**
208 * @brief wait for N ms
209 *
210 * @param int x
211 *
212 * @return none
213 */
wait_ms(int x)214 void wait_ms(int x)
215 {
216 if (x==0)
217 return;
218 MsOS_DelayTask(x);
219 }
220
221 /**
222 * @brief create USB event flag
223 *
224 * @param S32 *USBWaitFlg
225 *
226 * @return none
227 */
ms_init_OS_Resource_EX(S32 * USBWaitFlg)228 void ms_init_OS_Resource_EX(S32 *USBWaitFlg)
229 {
230 *USBWaitFlg = MsOS_CreateEventGroup("USB_Event");
231 }
232
ms_release_OS_Resource_EX(S32 * USBWaitFlg)233 void ms_release_OS_Resource_EX(S32 *USBWaitFlg)
234 {
235 MsOS_DeleteEventGroup(*USBWaitFlg);
236 }
237
238