--- /dev/null
+/******************************************************************************\r
+ *\r
+ * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.\r
+ * \r
+ * This program is free software; you can redistribute it and/or modify it\r
+ * under the terms of version 2 of the GNU General Public License as\r
+ * published by the Free Software Foundation.\r
+ *\r
+ * This program is distributed in the hope that it will be useful, but WITHOUT\r
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or\r
+ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for\r
+ * more details.\r
+ *\r
+ * You should have received a copy of the GNU General Public License along with\r
+ * this program; if not, write to the Free Software Foundation, Inc.,\r
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA\r
+ *\r
+ *\r
+ ******************************************************************************/\r
+\r
+#include <drv_types.h>\r
+#include <hal_data.h>\r
+#include <rtw_sreset.h>\r
+\r
+void sreset_init_value(_adapter *padapter)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_DETECT)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ struct sreset_priv *psrtpriv = &pHalData->srestpriv;\r
+\r
+ _rtw_mutex_init(&psrtpriv->silentreset_mutex);\r
+ psrtpriv->silent_reset_inprogress = _FALSE;\r
+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;\r
+ psrtpriv->last_tx_time =0;\r
+ psrtpriv->last_tx_complete_time =0;\r
+#endif\r
+}\r
+void sreset_reset_value(_adapter *padapter)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_DETECT)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ struct sreset_priv *psrtpriv = &pHalData->srestpriv;\r
+\r
+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;\r
+ psrtpriv->last_tx_time =0;\r
+ psrtpriv->last_tx_complete_time =0;\r
+#endif\r
+}\r
+\r
+u8 sreset_get_wifi_status(_adapter *padapter)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_DETECT)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ struct sreset_priv *psrtpriv = &pHalData->srestpriv;\r
+\r
+ u8 status = WIFI_STATUS_SUCCESS;\r
+ u32 val32 = 0;\r
+ _irqL irqL;\r
+ if(psrtpriv->silent_reset_inprogress == _TRUE)\r
+ {\r
+ return status;\r
+ }\r
+ val32 =rtw_read32(padapter,REG_TXDMA_STATUS);\r
+ if(val32==0xeaeaeaea){\r
+ psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST;\r
+ }\r
+ else if(val32!=0){\r
+ DBG_8192C("txdmastatu(%x)\n",val32);\r
+ psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR;\r
+ }\r
+\r
+ if(WIFI_STATUS_SUCCESS !=psrtpriv->Wifi_Error_Status)\r
+ {\r
+ DBG_8192C("==>%s error_status(0x%x) \n",__FUNCTION__,psrtpriv->Wifi_Error_Status);\r
+ status = (psrtpriv->Wifi_Error_Status &( ~(USB_READ_PORT_FAIL|USB_WRITE_PORT_FAIL)));\r
+ }\r
+ DBG_8192C("==> %s wifi_status(0x%x)\n",__FUNCTION__,status);\r
+\r
+ //status restore\r
+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;\r
+\r
+ return status;\r
+#else\r
+ return WIFI_STATUS_SUCCESS;\r
+#endif\r
+}\r
+\r
+void sreset_set_wifi_error_status(_adapter *padapter, u32 status)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_DETECT)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ pHalData->srestpriv.Wifi_Error_Status = status;\r
+#endif\r
+}\r
+\r
+void sreset_set_trigger_point(_adapter *padapter, s32 tgp)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_DETECT)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ pHalData->srestpriv.dbg_trigger_point = tgp;\r
+#endif\r
+}\r
+\r
+bool sreset_inprogress(_adapter *padapter)\r
+{\r
+#if defined(DBG_CONFIG_ERROR_RESET)\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ return pHalData->srestpriv.silent_reset_inprogress;\r
+#else\r
+ return _FALSE;\r
+#endif\r
+}\r
+\r
+void sreset_restore_security_station(_adapter *padapter)\r
+{\r
+ u8 EntryId = 0;\r
+ struct mlme_priv *mlmepriv = &padapter->mlmepriv;\r
+ struct sta_priv * pstapriv = &padapter->stapriv;\r
+ struct sta_info *psta;\r
+ struct security_priv* psecuritypriv=&(padapter->securitypriv);\r
+ struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info;\r
+\r
+ {\r
+ u8 val8;\r
+\r
+ if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) {\r
+ val8 = 0xcc;\r
+ #ifdef CONFIG_WAPI_SUPPORT\r
+ } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) {\r
+ //Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey.\r
+ val8 = 0x4c;\r
+ #endif\r
+ } else {\r
+ val8 = 0xcf;\r
+ }\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8));\r
+ }\r
+\r
+ #if 0\r
+ if ( ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_ ) ||\r
+ ( padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_ ))\r
+ {\r
+\r
+ for(EntryId=0; EntryId<4; EntryId++)\r
+ {\r
+ if(EntryId == psecuritypriv->dot11PrivacyKeyIndex)\r
+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 1,_FALSE);\r
+ else\r
+ rtw_set_key(padapter,&padapter->securitypriv, EntryId, 0,_FALSE);\r
+ }\r
+\r
+ }\r
+ else\r
+ #endif\r
+ if((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) ||\r
+ (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_))\r
+ {\r
+ psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv));\r
+ if (psta == NULL) {\r
+ //DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail \n"));\r
+ }\r
+ else\r
+ {\r
+ //pairwise key\r
+ rtw_setstakey_cmd(padapter, psta, UNICAST_KEY,_FALSE);\r
+ //group key\r
+ rtw_set_key(padapter,&padapter->securitypriv,padapter->securitypriv.dot118021XGrpKeyid, 0,_FALSE);\r
+ }\r
+ }\r
+}\r
+\r
+void sreset_restore_network_station(_adapter *padapter)\r
+{\r
+ struct mlme_priv *mlmepriv = &padapter->mlmepriv;\r
+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;\r
+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);\r
+ u8 doiqk = _FALSE;\r
+\r
+ #if 0\r
+ {\r
+ //=======================================================\r
+ // reset related register of Beacon control\r
+\r
+ //set MSR to nolink\r
+ Set_MSR(padapter, _HW_STATE_NOLINK_); \r
+ // reject all data frame\r
+ rtw_write16(padapter, REG_RXFLTMAP2,0x00);\r
+ //reset TSF\r
+ rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0)|BIT(1)));\r
+\r
+ // disable update TSF\r
+ SetBcnCtrlReg(padapter, BIT(4), 0);\r
+\r
+ //=======================================================\r
+ }\r
+ #endif\r
+ \r
+ rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure,_FALSE);\r
+\r
+ {\r
+ u8 threshold;\r
+ #ifdef CONFIG_USB_HCI\r
+ // TH=1 => means that invalidate usb rx aggregation\r
+ // TH=0 => means that validate usb rx aggregation, use init value.\r
+ if(mlmepriv->htpriv.ht_option) {\r
+ if(padapter->registrypriv.wifi_spec==1) \r
+ threshold = 1;\r
+ else\r
+ threshold = 0;\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold));\r
+ } else {\r
+ threshold = 1;\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold));\r
+ }\r
+ #endif\r
+ }\r
+\r
+ doiqk = _TRUE;\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK , &doiqk);\r
+\r
+ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode);\r
+\r
+ doiqk = _FALSE;\r
+ rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk);\r
+ //disable dynamic functions, such as high power, DIG\r
+ /*rtw_phydm_func_disable_all(padapter);*/\r
+ \r
+ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress);\r
+\r
+ {\r
+ u8 join_type = 0;\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type));\r
+ }\r
+\r
+ Set_MSR(padapter, (pmlmeinfo->state & 0x3));\r
+\r
+ mlmeext_joinbss_event_callback(padapter, 1);\r
+ //restore Sequence No.\r
+ rtw_hal_set_hwreg(padapter, HW_VAR_RESTORE_HW_SEQ, 0);\r
+\r
+ sreset_restore_security_station(padapter);\r
+}\r
+\r
+\r
+void sreset_restore_network_status(_adapter *padapter)\r
+{\r
+ struct mlme_priv *mlmepriv = &padapter->mlmepriv;\r
+ struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;\r
+ struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);\r
+\r
+ if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) {\r
+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));\r
+ sreset_restore_network_station(padapter);\r
+ } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) {\r
+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));\r
+ rtw_ap_restore_network(padapter);\r
+ } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) {\r
+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));\r
+ } else {\r
+ DBG_871X(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));\r
+ }\r
+}\r
+\r
+void sreset_stop_adapter(_adapter *padapter)\r
+{\r
+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);\r
+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv;\r
+\r
+ if (padapter == NULL)\r
+ return;\r
+\r
+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));\r
+\r
+ rtw_netif_stop_queue(padapter->pnetdev);\r
+\r
+ rtw_cancel_all_timer(padapter);\r
+\r
+ /* TODO: OS and HCI independent */\r
+ #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI)\r
+ tasklet_kill(&pxmitpriv->xmit_tasklet);\r
+ #endif\r
+\r
+ if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))\r
+ rtw_scan_abort(padapter);\r
+\r
+ if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))\r
+ {\r
+ rtw_set_to_roam(padapter, 0);\r
+ _rtw_join_timeout_handler(padapter);\r
+ }\r
+\r
+}\r
+\r
+void sreset_start_adapter(_adapter *padapter)\r
+{\r
+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);\r
+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv;\r
+\r
+ if (padapter == NULL)\r
+ return;\r
+\r
+ DBG_871X(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));\r
+\r
+ if (check_fwstate(pmlmepriv, _FW_LINKED)) {\r
+ sreset_restore_network_status(padapter);\r
+ }\r
+\r
+ /* TODO: OS and HCI independent */\r
+ #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI)\r
+ tasklet_hi_schedule(&pxmitpriv->xmit_tasklet);\r
+ #endif\r
+\r
+ if (is_primary_adapter(padapter))\r
+ _set_timer(&padapter->mlmepriv.dynamic_chk_timer, 2000);\r
+\r
+ rtw_netif_wake_queue(padapter->pnetdev);\r
+}\r
+\r
+void sreset_reset(_adapter *padapter)\r
+{\r
+#ifdef DBG_CONFIG_ERROR_RESET\r
+ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);\r
+ struct sreset_priv *psrtpriv = &pHalData->srestpriv;\r
+ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);\r
+ struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);\r
+ struct xmit_priv *pxmitpriv = &padapter->xmitpriv;\r
+ _irqL irqL;\r
+ u32 start = rtw_get_current_time();\r
+ struct dvobj_priv *psdpriv = padapter->dvobj;\r
+ struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;\r
+\r
+ DBG_871X("%s\n", __FUNCTION__);\r
+\r
+ psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;\r
+\r
+\r
+#ifdef CONFIG_LPS\r
+ rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "SRESET");\r
+#endif//#ifdef CONFIG_LPS\r
+ \r
+ _enter_pwrlock(&pwrpriv->lock);\r
+\r
+ psrtpriv->silent_reset_inprogress = _TRUE;\r
+ pwrpriv->change_rfpwrstate = rf_off;\r
+\r
+ sreset_stop_adapter(padapter);\r
+ #ifdef CONFIG_CONCURRENT_MODE\r
+ sreset_stop_adapter(padapter->pbuddy_adapter);\r
+ #endif\r
+\r
+ #ifdef CONFIG_IPS\r
+ _ips_enter(padapter);\r
+ _ips_leave(padapter);\r
+ #endif\r
+\r
+ sreset_start_adapter(padapter);\r
+ #ifdef CONFIG_CONCURRENT_MODE\r
+ sreset_start_adapter(padapter->pbuddy_adapter);\r
+ #endif\r
+\r
+ psrtpriv->silent_reset_inprogress = _FALSE;\r
+\r
+ _exit_pwrlock(&pwrpriv->lock);\r
+\r
+ DBG_871X("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start));\r
+ pdbgpriv->dbg_sreset_cnt++;\r
+#endif\r
+}\r
+\r