mirror of
https://github.com/lwfinger/rtl8188eu.git
synced 2024-11-24 21:43:40 +00:00
271 lines
7.3 KiB
C
271 lines
7.3 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.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
*
|
|
*
|
|
******************************************************************************/
|
|
|
|
#include "odm_precomp.h"
|
|
|
|
#include <rtw_iol.h>
|
|
|
|
static bool CheckCondition(const u4Byte Condition, const u4Byte Hex)
|
|
{
|
|
u4Byte _board = (Hex & 0x000000FF);
|
|
u4Byte _interface = (Hex & 0x0000FF00) >> 8;
|
|
u4Byte _platform = (Hex & 0x00FF0000) >> 16;
|
|
u4Byte cond = Condition;
|
|
|
|
if (Condition == 0xCDCDCDCD)
|
|
return true;
|
|
|
|
cond = Condition & 0x000000FF;
|
|
if ((_board == cond) && cond != 0x00)
|
|
return false;
|
|
|
|
cond = Condition & 0x0000FF00;
|
|
cond = cond >> 8;
|
|
if ((_interface & cond) == 0 && cond != 0x07)
|
|
return false;
|
|
|
|
cond = Condition & 0x00FF0000;
|
|
cond = cond >> 16;
|
|
if ((_platform & cond) == 0 && cond != 0x0F)
|
|
return false;
|
|
return true;
|
|
}
|
|
|
|
|
|
/******************************************************************************
|
|
* RadioA_1T.TXT
|
|
******************************************************************************/
|
|
|
|
static u4Byte Array_RadioA_1T_8188E[] = {
|
|
0x000, 0x00030000,
|
|
0x008, 0x00084000,
|
|
0x018, 0x00000407,
|
|
0x019, 0x00000012,
|
|
0x01E, 0x00080009,
|
|
0x01F, 0x00000880,
|
|
0x02F, 0x0001A060,
|
|
0x03F, 0x00000000,
|
|
0x042, 0x000060C0,
|
|
0x057, 0x000D0000,
|
|
0x058, 0x000BE180,
|
|
0x067, 0x00001552,
|
|
0x083, 0x00000000,
|
|
0x0B0, 0x000FF8FC,
|
|
0x0B1, 0x00054400,
|
|
0x0B2, 0x000CCC19,
|
|
0x0B4, 0x00043003,
|
|
0x0B6, 0x0004953E,
|
|
0x0B7, 0x0001C718,
|
|
0x0B8, 0x000060FF,
|
|
0x0B9, 0x00080001,
|
|
0x0BA, 0x00040000,
|
|
0x0BB, 0x00000400,
|
|
0x0BF, 0x000C0000,
|
|
0x0C2, 0x00002400,
|
|
0x0C3, 0x00000009,
|
|
0x0C4, 0x00040C91,
|
|
0x0C5, 0x00099999,
|
|
0x0C6, 0x000000A3,
|
|
0x0C7, 0x00088820,
|
|
0x0C8, 0x00076C06,
|
|
0x0C9, 0x00000000,
|
|
0x0CA, 0x00080000,
|
|
0x0DF, 0x00000180,
|
|
0x0EF, 0x000001A0,
|
|
0x051, 0x0006B27D,
|
|
0xFF0F041F, 0xABCD,
|
|
0x052, 0x0007E4DD,
|
|
0xCDCDCDCD, 0xCDCD,
|
|
0x052, 0x0007E49D,
|
|
0xFF0F041F, 0xDEAD,
|
|
0x053, 0x00000073,
|
|
0x056, 0x00051FF3,
|
|
0x035, 0x00000086,
|
|
0x035, 0x00000186,
|
|
0x035, 0x00000286,
|
|
0x036, 0x00001C25,
|
|
0x036, 0x00009C25,
|
|
0x036, 0x00011C25,
|
|
0x036, 0x00019C25,
|
|
0x0B6, 0x00048538,
|
|
0x018, 0x00000C07,
|
|
0x05A, 0x0004BD00,
|
|
0x019, 0x000739D0,
|
|
0x034, 0x0000ADF3,
|
|
0x034, 0x00009DF0,
|
|
0x034, 0x00008DED,
|
|
0x034, 0x00007DEA,
|
|
0x034, 0x00006DE7,
|
|
0x034, 0x000054EE,
|
|
0x034, 0x000044EB,
|
|
0x034, 0x000034E8,
|
|
0x034, 0x0000246B,
|
|
0x034, 0x00001468,
|
|
0x034, 0x0000006D,
|
|
0x000, 0x00030159,
|
|
0x084, 0x00068200,
|
|
0x086, 0x000000CE,
|
|
0x087, 0x00048A00,
|
|
0x08E, 0x00065540,
|
|
0x08F, 0x00088000,
|
|
0x0EF, 0x000020A0,
|
|
0x03B, 0x000F02B0,
|
|
0x03B, 0x000EF7B0,
|
|
0x03B, 0x000D4FB0,
|
|
0x03B, 0x000CF060,
|
|
0x03B, 0x000B0090,
|
|
0x03B, 0x000A0080,
|
|
0x03B, 0x00090080,
|
|
0x03B, 0x0008F780,
|
|
0x03B, 0x000722B0,
|
|
0x03B, 0x0006F7B0,
|
|
0x03B, 0x00054FB0,
|
|
0x03B, 0x0004F060,
|
|
0x03B, 0x00030090,
|
|
0x03B, 0x00020080,
|
|
0x03B, 0x00010080,
|
|
0x03B, 0x0000F780,
|
|
0x0EF, 0x000000A0,
|
|
0x000, 0x00010159,
|
|
0x018, 0x0000F407,
|
|
0xFFE, 0x00000000,
|
|
0xFFE, 0x00000000,
|
|
0x01F, 0x00080003,
|
|
0xFFE, 0x00000000,
|
|
0xFFE, 0x00000000,
|
|
0x01E, 0x00000001,
|
|
0x01F, 0x00080000,
|
|
0x000, 0x00033E60,
|
|
};
|
|
|
|
enum HAL_STATUS ODM_ReadAndConfig_RadioA_1T_8188E(struct odm_dm_struct *pDM_Odm)
|
|
{
|
|
#define READ_NEXT_PAIR(v1, v2, i) do \
|
|
{ i += 2; v1 = Array[i]; \
|
|
v2 = Array[i+1]; } while (0)
|
|
|
|
u4Byte hex = 0;
|
|
u4Byte i = 0;
|
|
u2Byte count = 0;
|
|
pu4Byte ptr_array = NULL;
|
|
u1Byte platform = pDM_Odm->SupportPlatform;
|
|
u1Byte interfaceValue = pDM_Odm->SupportInterface;
|
|
u1Byte board = pDM_Odm->BoardType;
|
|
u4Byte ArrayLen = sizeof(Array_RadioA_1T_8188E)/sizeof(u4Byte);
|
|
pu4Byte Array = Array_RadioA_1T_8188E;
|
|
bool biol = false;
|
|
struct adapter *Adapter = pDM_Odm->Adapter;
|
|
struct xmit_frame *pxmit_frame;
|
|
u8 bndy_cnt = 1;
|
|
enum HAL_STATUS rst = HAL_STATUS_SUCCESS;
|
|
|
|
hex += board;
|
|
hex += interfaceValue << 8;
|
|
hex += platform << 16;
|
|
hex += 0xFF000000;
|
|
biol = rtw_IOL_applied(Adapter);
|
|
|
|
if (biol) {
|
|
pxmit_frame = rtw_IOL_accquire_xmit_frame(Adapter);
|
|
if (pxmit_frame== NULL) {
|
|
pr_info("rtw_IOL_accquire_xmit_frame failed\n");
|
|
return HAL_STATUS_FAILURE;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ArrayLen; i += 2) {
|
|
u4Byte v1 = Array[i];
|
|
u4Byte v2 = Array[i+1];
|
|
|
|
/* This (offset, data) pair meets the condition. */
|
|
if (v1 < 0xCDCDCDCD) {
|
|
if (biol) {
|
|
if (rtw_IOL_cmd_boundary_handle(pxmit_frame))
|
|
bndy_cnt++;
|
|
|
|
if (v1 == 0xffe)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 50);
|
|
else if (v1 == 0xfd)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 5);
|
|
else if (v1 == 0xfc)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 1);
|
|
else if (v1 == 0xfb)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 50);
|
|
else if (v1 == 0xfa)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 5);
|
|
else if (v1 == 0xf9)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 1);
|
|
else
|
|
rtw_IOL_append_WRF_cmd(pxmit_frame, ODM_RF_PATH_A, (u2Byte)v1, v2, bRFRegOffsetMask);
|
|
} else {
|
|
odm_ConfigRF_RadioA_8188E(pDM_Odm, v1, v2);
|
|
}
|
|
continue;
|
|
} else { /* This line is the start line of branch. */
|
|
if (!CheckCondition(Array[i], hex)) {
|
|
/* Discard the following (offset, data) pairs. */
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
while (v2 != 0xDEAD &&
|
|
v2 != 0xCDEF &&
|
|
v2 != 0xCDCD && 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. */
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
while (v2 != 0xDEAD &&
|
|
v2 != 0xCDEF &&
|
|
v2 != 0xCDCD && i < ArrayLen - 2) {
|
|
if (biol) {
|
|
if (rtw_IOL_cmd_boundary_handle(pxmit_frame))
|
|
bndy_cnt++;
|
|
|
|
if (v1 == 0xffe)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 50);
|
|
else if (v1 == 0xfd)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 5);
|
|
else if (v1 == 0xfc)
|
|
rtw_IOL_append_DELAY_MS_cmd(pxmit_frame, 1);
|
|
else if (v1 == 0xfb)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 50);
|
|
else if (v1 == 0xfa)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 5);
|
|
else if (v1 == 0xf9)
|
|
rtw_IOL_append_DELAY_US_cmd(pxmit_frame, 1);
|
|
else
|
|
rtw_IOL_append_WRF_cmd(pxmit_frame, ODM_RF_PATH_A, (u2Byte)v1, v2, bRFRegOffsetMask);
|
|
} else {
|
|
odm_ConfigRF_RadioA_8188E(pDM_Odm, v1, v2);
|
|
}
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
}
|
|
|
|
while (v2 != 0xDEAD && i < ArrayLen - 2)
|
|
READ_NEXT_PAIR(v1, v2, i);
|
|
}
|
|
}
|
|
}
|
|
if (biol) {
|
|
if (!rtw_IOL_exec_cmds_sync(pDM_Odm->Adapter, pxmit_frame, 1000, bndy_cnt)) {
|
|
rst = HAL_STATUS_FAILURE;
|
|
pr_info("~~~ IOL Config %s Failed !!!\n", __func__);
|
|
}
|
|
}
|
|
return rst;
|
|
}
|