xref: /utopia/UTPA2-700.0.x/modules/usb/drv/usb_ecos/newhost/include/drvBitops.h (revision 53ee8cc121a030b8d368113ac3e966b4705770ef)
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 #ifndef __DRV_BITOPS_H
79 #define __DRV_BITOPS_H
80 
81 #include <MsTypes.h>
82 
83 // find first bit set
generic_ffs(int x)84 static __inline__ int generic_ffs(int x)
85 {
86     int r = 1;
87 
88     if (!x)
89         return 0;
90     if (!(x & 0xffff))
91     {
92         x >>= 16;
93         r += 16;
94     }
95     if (!(x & 0xff))
96     {
97         x >>= 8;
98         r += 8;
99     }
100     if (!(x & 0xf))
101     {
102         x >>= 4;
103         r += 4;
104     }
105     if (!(x & 3))
106     {
107         x >>= 2;
108         r += 2;
109     }
110     if (!(x & 1))
111     {
112         x >>= 1;
113         r += 1;
114     }
115     return r;
116 }
117 
__test_bit(int nr,const MS_U32 * p)118 static __inline__ int __test_bit(int nr, const MS_U32 * p)
119 {
120     return (p[nr >> 5] >> (nr & 31)) & 1UL;
121 }
122 
123 #define ms_find_1st_set(x)      generic_ffs(x)
124 #define ms_test_bit(nr,p)       __test_bit(nr,p)
125 #define ms_clear_bit(nr,addr,type) *(addr) = (volatile type )( (~( (type)1 << (type)nr)) & (type)(*((volatile type *)(addr))))
126 #define ms_set_bit(nr,addr,type)   *(addr) = (volatile type )( ( ( (type)1 << (type)nr)) | (type)(*((volatile type *)(addr))))
127 
ms_devmap_clear_bit(MS_U32 nr,MS_U32 * p)128 static __inline__ void ms_devmap_clear_bit(MS_U32 nr, MS_U32 *p)
129 {
130     int bit = nr & (8 * sizeof(MS_U32) - 1);
131     int idx = nr >> 5;
132 
133     ms_clear_bit(bit, &p[idx], MS_U32);
134 }
135 
ms_devmap_set_bit(MS_U32 nr,MS_U32 * p)136 static __inline__ void ms_devmap_set_bit(MS_U32 nr, MS_U32 *p)
137 {
138     int bit = nr & (8 * sizeof(MS_U32) - 1);
139     int idx = nr >> 5;
140 
141     ms_set_bit(bit, &p[idx], MS_U32);
142 }
143 
__ms_test_and_clear_bit_le(MS_U32 nr,MS_U32 * p)144 static __inline__ int __ms_test_and_clear_bit_le(MS_U32 nr, MS_U32 *p)
145 {
146     int oldVal = (*p >> (nr & 31)) & 1UL;
147 
148     ms_clear_bit(nr, p, MS_U32);
149     return oldVal;
150 }
151 
__ms_test_and_set_bit_le(MS_U32 nr,MS_U32 * p)152 static __inline__ int __ms_test_and_set_bit_le(MS_U32 nr, MS_U32 *p)
153 {
154     int oldVal = (*p >> (nr & 31)) & 1UL;
155 
156     ms_set_bit(nr, p, MS_U32);
157     return oldVal;
158 }
159 
160  // APIs for little endian
161 #define ms_test_and_set_bit(nr,p)    __ms_test_and_set_bit_le(nr,p)
162 #define ms_test_and_clear_bit(nr,p)  __ms_test_and_clear_bit_le(nr,p)
163 extern int find_next_zero_bit_le (void *p, int size, int offset);
164 #define find_next_zero_bit(p,size,offset)  find_next_zero_bit_le(p,size,offset)
165 
166 #endif
167