1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
4 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
6 ******************************************************************************/
8 #include <linux/kernel.h>
9 #include "odm_precomp.h"
11 static bool CheckPositive(
12 struct dm_odm_t *pDM_Odm, const u32 Condition1, const u32 Condition2
16 ((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */
17 ((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */
18 ((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */
19 ((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */
20 ((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT */
22 u32 cond1 = Condition1, cond2 = Condition2;
24 pDM_Odm->CutVersion << 24 |
25 pDM_Odm->SupportPlatform << 16 |
26 pDM_Odm->PackageType << 12 |
27 pDM_Odm->SupportInterface << 8 |
31 pDM_Odm->TypeGLNA << 0 |
32 pDM_Odm->TypeGPA << 8 |
33 pDM_Odm->TypeALNA << 16 |
34 pDM_Odm->TypeAPA << 24;
37 /* Value Defined Check =============== */
38 /* QFN Type [15:12] and Cut Version [27:24] need to do value check */
40 if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000)))
42 if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000)))
45 /* Bit Defined Check ================ */
46 /* We don't care [31:28] and [23:20] */
49 driver1 &= 0x000F0FFF;
51 if ((cond1 & driver1) == cond1) {
53 if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */
56 if ((cond1 & BIT0) != 0) /* GLNA */
57 bitMask |= 0x000000FF;
58 if ((cond1 & BIT1) != 0) /* GPA */
59 bitMask |= 0x0000FF00;
60 if ((cond1 & BIT2) != 0) /* ALNA */
61 bitMask |= 0x00FF0000;
62 if ((cond1 & BIT3) != 0) /* APA */
63 bitMask |= 0xFF000000;
65 if ((cond2 & bitMask) == (driver2 & bitMask)) /* BoardType of each RF path is matched */
71 static bool CheckNegative(
72 struct dm_odm_t *pDM_Odm, const u32 Condition1, const u32 Condition2
78 /******************************************************************************
80 ******************************************************************************/
82 static u32 Array_MP_8723B_MAC_REG[] = {
189 void ODM_ReadAndConfig_MP_8723B_MAC_REG(struct dm_odm_t *pDM_Odm)
192 u32 ArrayLen = ARRAY_SIZE(Array_MP_8723B_MAC_REG);
193 u32 *Array = Array_MP_8723B_MAC_REG;
195 for (i = 0; i < ArrayLen; i += 2) {
199 /* This (offset, data) pair doesn't care the condition. */
200 if (v1 < 0x40000000) {
201 odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
204 /* This line is the beginning of branch. */
205 bool bMatched = true;
206 u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);
208 if (cCond == COND_ELSE) { /* ELSE, ENDIF */
210 READ_NEXT_PAIR(v1, v2, i);
211 } else if (!CheckPositive(pDM_Odm, v1, v2)) {
213 READ_NEXT_PAIR(v1, v2, i);
214 READ_NEXT_PAIR(v1, v2, i);
216 READ_NEXT_PAIR(v1, v2, i);
217 if (!CheckNegative(pDM_Odm, v1, v2))
221 READ_NEXT_PAIR(v1, v2, i);
225 /* Condition isn't matched. Discard the following (offset, data) pairs. */
226 while (v1 < 0x40000000 && i < ArrayLen-2)
227 READ_NEXT_PAIR(v1, v2, i);
229 i -= 2; /* prevent from for-loop += 2 */
230 } else { /* Configure matched pairs and skip to end of if-else. */
231 while (v1 < 0x40000000 && i < ArrayLen-2) {
232 odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
233 READ_NEXT_PAIR(v1, v2, i);
236 /* Keeps reading until ENDIF. */
237 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);
238 while (cCond != COND_ENDIF && i < ArrayLen-2) {
239 READ_NEXT_PAIR(v1, v2, i);
240 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);