303 lines
7.1 KiB
C
303 lines
7.1 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
******************************************************************************/
|
|
|
|
|
|
#include "odm_precomp.h"
|
|
|
|
static bool CheckPositive(
|
|
PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2
|
|
)
|
|
{
|
|
u8 _BoardType =
|
|
((pDM_Odm->BoardType & BIT4) >> 4) << 0 | /* _GLNA */
|
|
((pDM_Odm->BoardType & BIT3) >> 3) << 1 | /* _GPA */
|
|
((pDM_Odm->BoardType & BIT7) >> 7) << 2 | /* _ALNA */
|
|
((pDM_Odm->BoardType & BIT6) >> 6) << 3 | /* _APA */
|
|
((pDM_Odm->BoardType & BIT2) >> 2) << 4; /* _BT */
|
|
|
|
u32 cond1 = Condition1, cond2 = Condition2;
|
|
u32 driver1 =
|
|
pDM_Odm->CutVersion << 24 |
|
|
pDM_Odm->SupportPlatform << 16 |
|
|
pDM_Odm->PackageType << 12 |
|
|
pDM_Odm->SupportInterface << 8 |
|
|
_BoardType;
|
|
|
|
u32 driver2 =
|
|
pDM_Odm->TypeGLNA << 0 |
|
|
pDM_Odm->TypeGPA << 8 |
|
|
pDM_Odm->TypeALNA << 16 |
|
|
pDM_Odm->TypeAPA << 24;
|
|
|
|
ODM_RT_TRACE(
|
|
pDM_Odm,
|
|
ODM_COMP_INIT,
|
|
ODM_DBG_TRACE,
|
|
(
|
|
"===> [8812A] CheckPositive (cond1, cond2) = (0x%X 0x%X)\n",
|
|
cond1,
|
|
cond2
|
|
)
|
|
);
|
|
ODM_RT_TRACE(
|
|
pDM_Odm,
|
|
ODM_COMP_INIT,
|
|
ODM_DBG_TRACE,
|
|
(
|
|
"===> [8812A] CheckPositive (driver1, driver2) = (0x%X 0x%X)\n",
|
|
driver1,
|
|
driver2
|
|
)
|
|
);
|
|
|
|
ODM_RT_TRACE(
|
|
pDM_Odm,
|
|
ODM_COMP_INIT,
|
|
ODM_DBG_TRACE,
|
|
(
|
|
" (Platform, Interface) = (0x%X, 0x%X)\n",
|
|
pDM_Odm->SupportPlatform,
|
|
pDM_Odm->SupportInterface
|
|
)
|
|
);
|
|
ODM_RT_TRACE(
|
|
pDM_Odm,
|
|
ODM_COMP_INIT,
|
|
ODM_DBG_TRACE,
|
|
(
|
|
" (Board, Package) = (0x%X, 0x%X)\n",
|
|
pDM_Odm->BoardType,
|
|
pDM_Odm->PackageType
|
|
)
|
|
);
|
|
|
|
|
|
/* Value Defined Check =============== */
|
|
/* QFN Type [15:12] and Cut Version [27:24] need to do value check */
|
|
|
|
if (((cond1 & 0x0000F000) != 0) && ((cond1 & 0x0000F000) != (driver1 & 0x0000F000)))
|
|
return false;
|
|
if (((cond1 & 0x0F000000) != 0) && ((cond1 & 0x0F000000) != (driver1 & 0x0F000000)))
|
|
return false;
|
|
|
|
/* Bit Defined Check ================ */
|
|
/* We don't care [31:28] and [23:20] */
|
|
/* */
|
|
cond1 &= 0x000F0FFF;
|
|
driver1 &= 0x000F0FFF;
|
|
|
|
if ((cond1 & driver1) == cond1) {
|
|
u32 bitMask = 0;
|
|
if ((cond1 & 0x0F) == 0) /* BoardType is DONTCARE */
|
|
return true;
|
|
|
|
if ((cond1 & BIT0) != 0) /* GLNA */
|
|
bitMask |= 0x000000FF;
|
|
if ((cond1 & BIT1) != 0) /* GPA */
|
|
bitMask |= 0x0000FF00;
|
|
if ((cond1 & BIT2) != 0) /* ALNA */
|
|
bitMask |= 0x00FF0000;
|
|
if ((cond1 & BIT3) != 0) /* APA */
|
|
bitMask |= 0xFF000000;
|
|
|
|
if ((cond2 & bitMask) == (driver2 & bitMask)) /* BoardType of each RF path is matched */
|
|
return true;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
static bool CheckNegative(
|
|
PDM_ODM_T pDM_Odm, const u32 Condition1, const u32 Condition2
|
|
)
|
|
{
|
|
return true;
|
|
}
|
|
|
|
/******************************************************************************
|
|
* MAC_REG.TXT
|
|
******************************************************************************/
|
|
|
|
static u32 Array_MP_8723B_MAC_REG[] = {
|
|
0x02F, 0x00000030,
|
|
0x035, 0x00000000,
|
|
0x039, 0x00000008,
|
|
0x04E, 0x000000E0,
|
|
0x064, 0x00000000,
|
|
0x067, 0x00000020,
|
|
0x428, 0x0000000A,
|
|
0x429, 0x00000010,
|
|
0x430, 0x00000000,
|
|
0x431, 0x00000000,
|
|
0x432, 0x00000000,
|
|
0x433, 0x00000001,
|
|
0x434, 0x00000004,
|
|
0x435, 0x00000005,
|
|
0x436, 0x00000007,
|
|
0x437, 0x00000008,
|
|
0x43C, 0x00000004,
|
|
0x43D, 0x00000005,
|
|
0x43E, 0x00000007,
|
|
0x43F, 0x00000008,
|
|
0x440, 0x0000005D,
|
|
0x441, 0x00000001,
|
|
0x442, 0x00000000,
|
|
0x444, 0x00000010,
|
|
0x445, 0x00000000,
|
|
0x446, 0x00000000,
|
|
0x447, 0x00000000,
|
|
0x448, 0x00000000,
|
|
0x449, 0x000000F0,
|
|
0x44A, 0x0000000F,
|
|
0x44B, 0x0000003E,
|
|
0x44C, 0x00000010,
|
|
0x44D, 0x00000000,
|
|
0x44E, 0x00000000,
|
|
0x44F, 0x00000000,
|
|
0x450, 0x00000000,
|
|
0x451, 0x000000F0,
|
|
0x452, 0x0000000F,
|
|
0x453, 0x00000000,
|
|
0x456, 0x0000005E,
|
|
0x460, 0x00000066,
|
|
0x461, 0x00000066,
|
|
0x4C8, 0x000000FF,
|
|
0x4C9, 0x00000008,
|
|
0x4CC, 0x000000FF,
|
|
0x4CD, 0x000000FF,
|
|
0x4CE, 0x00000001,
|
|
0x500, 0x00000026,
|
|
0x501, 0x000000A2,
|
|
0x502, 0x0000002F,
|
|
0x503, 0x00000000,
|
|
0x504, 0x00000028,
|
|
0x505, 0x000000A3,
|
|
0x506, 0x0000005E,
|
|
0x507, 0x00000000,
|
|
0x508, 0x0000002B,
|
|
0x509, 0x000000A4,
|
|
0x50A, 0x0000005E,
|
|
0x50B, 0x00000000,
|
|
0x50C, 0x0000004F,
|
|
0x50D, 0x000000A4,
|
|
0x50E, 0x00000000,
|
|
0x50F, 0x00000000,
|
|
0x512, 0x0000001C,
|
|
0x514, 0x0000000A,
|
|
0x516, 0x0000000A,
|
|
0x525, 0x0000004F,
|
|
0x550, 0x00000010,
|
|
0x551, 0x00000010,
|
|
0x559, 0x00000002,
|
|
0x55C, 0x00000050,
|
|
0x55D, 0x000000FF,
|
|
0x605, 0x00000030,
|
|
0x608, 0x0000000E,
|
|
0x609, 0x0000002A,
|
|
0x620, 0x000000FF,
|
|
0x621, 0x000000FF,
|
|
0x622, 0x000000FF,
|
|
0x623, 0x000000FF,
|
|
0x624, 0x000000FF,
|
|
0x625, 0x000000FF,
|
|
0x626, 0x000000FF,
|
|
0x627, 0x000000FF,
|
|
0x638, 0x00000050,
|
|
0x63C, 0x0000000A,
|
|
0x63D, 0x0000000A,
|
|
0x63E, 0x0000000E,
|
|
0x63F, 0x0000000E,
|
|
0x640, 0x00000040,
|
|
0x642, 0x00000040,
|
|
0x643, 0x00000000,
|
|
0x652, 0x000000C8,
|
|
0x66E, 0x00000005,
|
|
0x700, 0x00000021,
|
|
0x701, 0x00000043,
|
|
0x702, 0x00000065,
|
|
0x703, 0x00000087,
|
|
0x708, 0x00000021,
|
|
0x709, 0x00000043,
|
|
0x70A, 0x00000065,
|
|
0x70B, 0x00000087,
|
|
0x765, 0x00000018,
|
|
0x76E, 0x00000004,
|
|
|
|
};
|
|
|
|
void ODM_ReadAndConfig_MP_8723B_MAC_REG(PDM_ODM_T pDM_Odm)
|
|
{
|
|
u32 i = 0;
|
|
u32 ArrayLen = sizeof(Array_MP_8723B_MAC_REG)/sizeof(u32);
|
|
u32 *Array = Array_MP_8723B_MAC_REG;
|
|
|
|
ODM_RT_TRACE(
|
|
pDM_Odm,
|
|
ODM_COMP_INIT,
|
|
ODM_DBG_LOUD,
|
|
("===> ODM_ReadAndConfig_MP_8723B_MAC_REG\n")
|
|
);
|
|
|
|
for (i = 0; i < ArrayLen; i += 2) {
|
|
u32 v1 = Array[i];
|
|
u32 v2 = Array[i+1];
|
|
|
|
/* This (offset, data) pair doesn't care the condition. */
|
|
if (v1 < 0x40000000) {
|
|
odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
|
|
continue;
|
|
} else {
|
|
/* This line is the beginning of branch. */
|
|
bool bMatched = true;
|
|
u8 cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);
|
|
|
|
if (cCond == COND_ELSE) { /* ELSE, ENDIF */
|
|
bMatched = true;
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
} else if (!CheckPositive(pDM_Odm, v1, v2)) {
|
|
bMatched = false;
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
} else {
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
if (!CheckNegative(pDM_Odm, v1, v2))
|
|
bMatched = false;
|
|
else
|
|
bMatched = true;
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
}
|
|
|
|
if (bMatched == false) {
|
|
/* Condition isn't matched. Discard the following (offset, data) pairs. */
|
|
while (v1 < 0x40000000 && i < ArrayLen-2)
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
|
|
i -= 2; /* prevent from for-loop += 2 */
|
|
} else { /* Configure matched pairs and skip to end of if-else. */
|
|
while (v1 < 0x40000000 && i < ArrayLen-2) {
|
|
odm_ConfigMAC_8723B(pDM_Odm, v1, (u8)v2);
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
}
|
|
|
|
/* Keeps reading until ENDIF. */
|
|
cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);
|
|
while (cCond != COND_ENDIF && i < ArrayLen-2) {
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
cCond = (u8)((v1 & (BIT29|BIT28)) >> 28);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|