/****************************************************************************** * * 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" #ifdef CONFIG_IOL_IOREG_CFG #include #endif #if (RTL8188E_SUPPORT == 1) 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; } /****************************************************************************** * MAC_REG.TXT ******************************************************************************/ static u4Byte Array_MAC_REG_8188E[] = { 0x026, 0x00000041, 0x027, 0x00000035, 0x428, 0x0000000A, 0x429, 0x00000010, 0x430, 0x00000000, 0x431, 0x00000001, 0x432, 0x00000002, 0x433, 0x00000004, 0x434, 0x00000005, 0x435, 0x00000006, 0x436, 0x00000007, 0x437, 0x00000008, 0x438, 0x00000000, 0x439, 0x00000000, 0x43A, 0x00000001, 0x43B, 0x00000002, 0x43C, 0x00000004, 0x43D, 0x00000005, 0x43E, 0x00000006, 0x43F, 0x00000007, 0x440, 0x0000005D, 0x441, 0x00000001, 0x442, 0x00000000, 0x444, 0x00000015, 0x445, 0x000000F0, 0x446, 0x0000000F, 0x447, 0x00000000, 0x458, 0x00000041, 0x459, 0x000000A8, 0x45A, 0x00000072, 0x45B, 0x000000B9, 0x460, 0x00000066, 0x461, 0x00000066, 0x480, 0x00000008, 0x4C8, 0x000000FF, 0x4C9, 0x00000008, 0x4CC, 0x000000FF, 0x4CD, 0x000000FF, 0x4CE, 0x00000001, 0x4D3, 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, 0x55D, 0x000000FF, 0x605, 0x00000030, 0x608, 0x0000000E, 0x609, 0x0000002A, 0x620, 0x000000FF, 0x621, 0x000000FF, 0x622, 0x000000FF, 0x623, 0x000000FF, 0x624, 0x000000FF, 0x625, 0x000000FF, 0x626, 0x000000FF, 0x627, 0x000000FF, 0x652, 0x00000020, 0x63C, 0x0000000A, 0x63D, 0x0000000A, 0x63E, 0x0000000E, 0x63F, 0x0000000E, 0x640, 0x00000040, 0x66E, 0x00000005, 0x700, 0x00000021, 0x701, 0x00000043, 0x702, 0x00000065, 0x703, 0x00000087, 0x708, 0x00000021, 0x709, 0x00000043, 0x70A, 0x00000065, 0x70B, 0x00000087, }; HAL_STATUS ODM_ReadAndConfig_MAC_REG_8188E( PDM_ODM_T 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_MAC_REG_8188E)/sizeof(u4Byte); pu4Byte Array = Array_MAC_REG_8188E; bool biol = false; #ifdef CONFIG_IOL_IOREG_CFG PADAPTER Adapter = pDM_Odm->Adapter; struct xmit_frame *pxmit_frame; u8 bndy_cnt = 1; #ifdef CONFIG_IOL_IOREG_CFG_DBG struct cmd_cmp cmpdata[ArrayLen]; u4Byte cmpdata_idx=0; #endif #endif //CONFIG_IOL_IOREG_CFG HAL_STATUS rst =HAL_STATUS_SUCCESS; hex += board; hex += interfaceValue << 8; hex += platform << 16; hex += 0xFF000000; #ifdef CONFIG_IOL_IOREG_CFG biol = rtw_IOL_applied(Adapter); if (biol){ if ((pxmit_frame=rtw_IOL_accquire_xmit_frame(Adapter)) == NULL) { printk("rtw_IOL_accquire_xmit_frame failed\n"); return HAL_STATUS_FAILURE; } } #endif //CONFIG_IOL_IOREG_CFG 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 ) { #ifdef CONFIG_IOL_IOREG_CFG if (biol){ if (rtw_IOL_cmd_boundary_handle(pxmit_frame)) bndy_cnt++; rtw_IOL_append_WB_cmd(pxmit_frame,(u2Byte)v1, (u1Byte)v2,0xFF); #ifdef CONFIG_IOL_IOREG_CFG_DBG cmpdata[cmpdata_idx].addr = v1; cmpdata[cmpdata_idx].value= v2; cmpdata_idx++; #endif } else #endif //endif CONFIG_IOL_IOREG_CFG { odm_ConfigMAC_8188E(pDM_Odm, v1, (u1Byte)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) { #ifdef CONFIG_IOL_IOREG_CFG if (biol){ if (rtw_IOL_cmd_boundary_handle(pxmit_frame)) bndy_cnt++; rtw_IOL_append_WB_cmd(pxmit_frame,(u2Byte)v1, (u1Byte)v2,0xFF); #ifdef CONFIG_IOL_IOREG_CFG_DBG cmpdata[cmpdata_idx].addr = v1; cmpdata[cmpdata_idx].value= v2; cmpdata_idx++; #endif } else #endif //#ifdef CONFIG_IOL_IOREG_CFG { odm_ConfigMAC_8188E(pDM_Odm, v1, (u1Byte)v2); } READ_NEXT_PAIR(v1, v2, i); } while (v2 != 0xDEAD && i < ArrayLen -2) { READ_NEXT_PAIR(v1, v2, i); } } } } #ifdef CONFIG_IOL_IOREG_CFG if (biol){ //printk("==> %s, pktlen = %d,bndy_cnt = %d\n",__func__,pxmit_frame->attrib.pktlen+4+32,bndy_cnt); if (rtw_IOL_exec_cmds_sync(pDM_Odm->Adapter, pxmit_frame, 1000, bndy_cnt)) { #ifdef CONFIG_IOL_IOREG_CFG_DBG printk("~~~ IOL Config MAC Success !!!\n"); //compare writed data { u4Byte idx; u1Byte cdata; // HAL_STATUS_FAILURE; printk(" MAC data compare => array_len:%d\n",cmpdata_idx); for (idx=0;idx< cmpdata_idx;idx++) { cdata = ODM_Read1Byte(pDM_Odm, cmpdata[idx].addr); if (cdata != cmpdata[idx].value){ printk("### MAC data compared failed !! addr:0x%04x, data:(0x%02x : 0x%02x) ###\n", cmpdata[idx].addr,cmpdata[idx].value,cdata); //rst = HAL_STATUS_FAILURE; } } //dump data from TX packet buffer //if (rst == HAL_STATUS_FAILURE) { rtw_IOL_cmd_tx_pkt_buf_dump(pDM_Odm->Adapter,pxmit_frame->attrib.pktlen+32); } } #endif //CONFIG_IOL_IOREG_CFG_DBG } else{ printk("~~~ MAC IOL_exec_cmds Failed !!!\n"); #ifdef CONFIG_IOL_IOREG_CFG_DBG { //dump data from TX packet buffer rtw_IOL_cmd_tx_pkt_buf_dump(pDM_Odm->Adapter,pxmit_frame->attrib.pktlen+32); } #endif //CONFIG_IOL_IOREG_CFG_DBG rst = HAL_STATUS_FAILURE; } } #endif //#ifdef CONFIG_IOL_IOREG_CFG return rst; } #endif // end of HWIMG_SUPPORT